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ABSTRACT 


A scheme to locate emitter positions using post flight 
processing of discrete airborne emitter bearing angles-of- 
arrival information and recorded aircraft position coor- 
dinates by Reiman filter techniques is developed. The 
Signal intercept system was assumed to be operating in a 
multi-emitter environment and all data was sampled at 
discrete but time varying intervals. The aircraft position 
data is filtered directly in latitude and longitude and 
emitter locations are computed in latitude and longitude 
using vector methods. An extended Kalman filtering scheme 
is develloped to compute emitter coordinates directly in 


latitude and longitude coordinates. 
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I. INTRODUCTION 


With the ever increasing reliance of the military forces 
on electromagnetic systems for communication, reconnais- 
Sance, and weapons control, there is a correspondingly 
increasing requirement to detect and locate the position of 
the enemy emitters. 

The complexity of this problem was shown by F. Pfendtner 
in [1]. When there are multiple emitters in reasonable 
proximity and several observations, called direction finding 
(DF) bearings, are made, the number of possible locations I, 


of these emitters is found by 


тт 


тй EE 


where m is the number of emitters and n is the number of 
observations. 

If there were six emitters and ten observations of each 
emitter, there would be a possibility of 1,620 points of 
bearing line intersections, each a valid emitter position. 

A scheme was developed in [1] to locate the most prob- 
able location of the emitter based on the mean of all points 
of intersection associated with a given target. This scheme 
did not provide the desired degree of accuracy. So, a 
scheme was developed to Kalman filter all of the DF bearing 
correlated with a given target, thus finding an optimal 


estimate of these observations. The first and last estimates 





of the DF bearings to each target were used to determine 
emitter location by triangulation methods. This scheme 
provided solutions much closer to the desired accuracy. 

Any solution is only as good as the data used to compute 
it, so, L. L. Coburn developed a data sort scheme in [2] 
which would compare all of the observations and correlate 
each data point with a specific target to avoid the pos- 
sibility of basing the solution of an emitter position on 
observations not from that target. The sort was based on 
signal carrier frequency and pulse repetition frequency, 
PRF. The data sort utilized in [2] was only an initial sort 
in that any observations not passing a later comparison test 
were discarded and not saved for locating further emitter 
sites. 

In this study an initial data sort based on signal 
carrier frequency and PRF is utilized, but all observations 
are eventually correlated to a target or are labeled as 
single line bearings. 

Also for this report a routine was developed to deter- 
mine Optimal жат of aircraft position coordinates by 
filtering and smoothing aircraft position observations. 

An extended Kalman filter was developed to filter the 
estimate of the target position directly in latitude and 
longitude. This routine could be used to track moving 
targets, or to filter emitter positions based on data from 


several flights. Only signal parameters, the estimates of 





aircraft position, observed DF bearing angles, time data, 
and the estimated target position would need to be stored 


from each flight for further processing. 








TT PROBLEM DESCRIPTION 


А. KALMAN FILTER THEORY 

Sequential estimation is characterized by the serial 
recursive processing of observations taken in time sequence. 
The result of every processing cycle is the current best 
estimate of the vector being estimated. This estimate there- 
рел embodies all observation data up to and including the 
current observation. As a new observation is made, the 
current estimate is updated to reflect this most recent data. 

In such an estimation scheme the calculations are iden- 
tical in nature from cycle to cycle so they are ideally 
suited for implementation on a digital computer. 

The problem presented in this report is that of the post 
flight processing of digitized data, butthe program utilized 
in. this case could easily be adapted for a real-time proces- 
sor for in-flight computing and real-time locating of emitter 
sites. 

The Kalman filter [3] is a recursive filter of the type 
needed for this application. Since the data inputs are 
already in digital form, the discrete form of the Kalman 
Filter are utilized for processing on a digital computer. 

From the probabilistic description of the random signal 
and noise we can determine the probability with which a 
Particular sample of the signal and noise will occur and we 
can therefore estimate x(k). This estimate will be denoted 


by x(k) 





The discrete system under consideration satisfies 
х (К+1) = ¢(k) x(k) + w(k) (1) 
z(k) = h(k)x(k) + v(k) (2) 


where x is ann x 1 state vector, Z is an m x 1 output vec- 
tor, w is a zero-mean n x l vector of state excitation 
white noise, uncorrelated with the zero-mean-additive 
observation white noise vector v, $ is the state transition 


matrix and h is the observation matrix. The noise statis- 


tics are 
Evo ν ο, ]- R(k) 6(k,j) (3) 
Ε]ν οκ) «i - Q(K) 6(k,Jj3) (4) 
45 «o = 0 for all (k,j) (5) 
0 Καὶ 
6(k,j) = (5) 
1 k = j 


The Kalman filter recursion equations [4] are summarized 
below where X(k|j) denotes the estimate of the state X(k) 


based. upon j measurement observations E DL DI 


P (k|k-1) = 6 (k,k-1)P (k-1|k-1) 6 (,k-1) T+Q (k) (7) 
$09 « » c [x-17100 [605 opc 00 T 09 | η (8) 
P(k|k) = P(k|k-1) - G(k)H(k)P (k|k-1) (9) 
Х(к|к) = X(k]k-1) + $00 [z 00 - A) (10) 
Х(к|к-1) = $(k,k-1)X(k-1|k-1) (11) 
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where G(k) is the Kalman filter gain matrix and P(k|j) is 


the error covariance matrix. 


В. SYSTEM MODELS 

The emitter position locating system modeled was divided 
into three distinct systems, (1) aircraft navigation system, 
(2) the DF bearings, and (3) the target location. The 
combined system consists of five linear Kalman filters, plus 
one linearized Kalman filter, called an extended Kalman 
filter, and two smoothing filters. Each of these models 
will be described briefly in this section with more detailed 
descriptions in Section III, “Computational Procedures." 

All of the systems are modeled by a linear 175° plant. 


The state transition matrix, ф, 15 


1 T (k+1) 
$ (k+1,k) = (12) 
0 1 


where T (1) = TIME T(k+1) - TIME T(k), TIME T being the 
time of observation. 

To minimize the affects of the inherent uncertainty of 
the system model, ЖТ С Gh ues of Q should be increased to a 
value which ensures that each observation is utilized. The 
effect of increasing the magnitude of Q is seen from (7) to 
be larger values of the error covariance matrix, P, which 
leads to an increase in the filter gain matrix G. This 
means that the filter is paying more attention to the actual 
measurement to compensate for errors in the plant model. 


Thus, the more nonlinear the system dynamics, the larger Q 


11 





should be. If the measurement errors are in question, R 
should be increased which, as can be seen from (8), will 
decrease G so the filter relies more on the total effect of 
all previous measurements, i.e. the previous estimate of the 
system states [5]. | 

1. Aircraft Navigation System Model 

The navigation system is modeled by a constant velo- 
city plant for each direction of aircraft travel, east-west 
and north-south, with the system states for each plant being 
aircraft position and aircraft velocity. Only the aircraft 
position fixes were observable so the objective of this 
filter is to filter the noisy observed position coordinates 
to obtain optimal estimates of own aircraft location. These 
estimates are used in processing the DF bearings and target 
positions. 

Since only aircraft position coordinates were observed, 
the observation matrix is H - 1 01. This made W(k),V(k) 
and R(k) scalar variance terms and the bracketed terms in (8) 
and (10) become scalar as well. 


Since W is a scalar, (4) becomes 
TE [w и | r“} = r r” E [w* ]. (13) 


Substituting the expression for T into (13) yields 





т‘ (к) — T?(k) 
у 4 NN 
Dk) - E [w°] d (к: (14) 
2 
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2. DF Bearing Model 

The system states for the problem of angle filtering 
are DF bearing angle-of-arrival and bearing rate. [In this 
program the system dynamics are also modeled by a constant 
velocity plant. The bearing rate is unobservable so the 
observation matrix is H - [1 0] as in the navigation data 
filter equations. 

This model does not accurately represent the actual 
system since the estimated angular rate error increases with 
time[1]. However by introducing a non zero Q matrix this 
error can be reduced. The effect of Q on the accuracy of 
this model can be seen in the results obtained by L. L. 
Coburn [2]. 

3. Target Position Coordinates Model . 

The states of the target location system are lati- 
tude, latitude rate, longitude, and longitude LONE while the 
observations are the noisy DF bearings only. To compute the 
optimal estimate of the states, the system was modeled by 
two linear constant velocity systems, one each for latitude 
and longitude. A linearize transformation of the measure- 
ment equation was utilized to provide DF bearing information 
to the latitude and longitude filters in a form they could 
use to filter their states. 

The models for the two linear systems are again 1/52 
Plants with H = [1 0]. 

The target location system model is shown in Fig. l, 
and is discussed further in Section III, part F, "Extended 


Kalman Filter." 
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с. SMOOTHING 

Two types of smoothing are utilized in this program, 
fixed point with the angle filter and fixed interval with 
the navigation data filter. The fixed point smoothing tech- 
nique will be discussed first. 

1. Fixed Point Smoothing 

In the process of angle filtering, the estimate of 

the DF bearing, ô (nin), is a weighted "average" of all 
previous noisy DF bearings, @(1),8(2),...,8(n). However the 
actual position finding algorithm (POSIT) utilizes the esti- 
mate of the first DF bearing, 8 (1|n), as well as 8 (n|n). 
So, the first bearing should be somehow weighted by all 
successive cuts, 0(2),...,8(n). The technique used to accom- 
plish this filtering is called fixed point smoothing. The 
smoothing equations are similar to the Kalman filter equa- 
tions in that they are recursive in nature and functions of 
similar statistical parameters. The difference is that the 
smoothing filters produce a previous estimate of the state 
subject to successive measurements. The fixed point smooth- 
ing equations used ES program are summarized below [6]. 


"cin Equation 
$&|3) 7 £xl3-n « wcog. cos lo» [zo 
~ н(3)ф (3,3-1) х(3-1|3-1)] (15) 


where j = k+l, k+2,..., and the initial condition is X(k|k). 


15 








b. Gain Equation 
W(j) = и(3-1)9 (3,3-1) [1-5(3)Р(313)] (16) 
where W(k) = P(kIk) ana s(3) = HG) TR? (35)H (3) 
с. Covariance Equation 
P(k|3) » P(k[3-1) - wG) [sc Gl3-2sG) 
+ 53) | wa ο τη) 


where the initial condition is P(k|k). P(j|j) and P (3lj-1) 
are the error covariance matrices from the optimal filter. 
2. Fixed Interval Smoothing 

The second type of smoothing utilized is the fixed 
interval smoothing. In the navigation data filtering routine, 
the flight track is broken into legs with a new leg being 
initiated any time the aircraft flies for more than two 
minutes without recording a position fix. Each leg is then 
an interval and each interval is filtered and smoothed 
separately. The motivation for the fixed interval smoothing 
routine is similar to that for smoothing in the angle filter- 
ing routine, i.e. each estimate should be influenced by each 
successive measurement as well as by each previous one. The 
fixed interval smoothing equations utilized in the angle 
filter are [6]. Utilized in the angle filter are [6]: 

a. Filter Equation 


X(k|n) = X(k|k) + A (k) [R (k+1|n) - X ei [xo | (18) 


for k 


n-l,n-2,...,0, where X(n|n) is the boundary condition 


for k п-1. 
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b. Gain Equation 


1 


А(к) < Р(к|к)ф (к+1,к) 1Р ^ (k«1|k) (19) 


с. Covariance Equation 
P (k|n) = P (k|k) + A(k) [P (x+1|n) 
- P(k+1|k)] A(k)* (20) 


This filter has the advantage taht it incorpor- 
ates the covariance terms, P (klk) and Р (к+ 1 | к), as well as 
the estimates X(k|k) and X(k+1|k) from the Kalman filter 
equations, so the required number of computations is mini- 
mized. Since k = n-l, n-2,...,0, it is clear that this 
system of equations is recursive backwards in time so it does 
indeed produce a smoothed estimate of each navigational fix 


subject to all successive fixes on that leg. 


D. INITIAL EMITTER POSITION FIXING 

Each position on the earth can be considered to be the 
tip of a vector whose length is the radius of the earth. 

In this problem the radius of the earth is assumed to 
be constant. Even though it is known that the constant 
radius assumption is an inaccurate one, using a constant 
value for the radius produces an error of less than two per- 
cent of the distance involved anywhere on the surface of the 
earth [7]. Also by using this assumption this method is 
equally valid over the entire globe without regard for the 
radius. 

The position vector can be described either by its lati- 


tude and longitude or in х,у, coordinates on a three 
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dimensional coordinate system with the center of the earth 
as the origin of the system, as in Fig. 2. 

The latitude is the angle in a meridian plane measured 
from the equatorial plane to the radius vector of the air- 
craft. Longitude is the angle in the equatorial plane 
measured from the Greenwich meridian to the meridian of the 
aircraft. The latitude of a point on the earth is in the 
range 0 to 90 degrees in the northern hemisphere and from 0 
to -90 degrees in the southern hemisphere. The longitude of 
a point on the earth is in the range 0 to 180 degrees in the 
eastern hemisphere and from 0 to -180 in the western hemis- 
phere. In the 3-D right hand coordinate system the positive 
z axis passes through the geographic north pole, the positive 
"x axis passes through the Greenwich meridian and lies in the 
equatorial plane and the positive y axis passes through 90 
degrees east longitude and lies in the equatorial plane [8]. 

The relationship between the latitude and longitude 
coordinates ($,0) and the (x,y,z) coordinates is expressed 


by the formulae 


x = соѕф cos® (21) 
у = соѕф ѕіпӨ (22) 
2 = sind (23) 


From vector algebra we know that when two vectors are 
multiplied together vectorially the resultant is called the 
cross product. The resultant is another vector whose direc- 


tion is perpendicular to the plane of both of the original 
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Figure 2. Illustration of Relation Between Station (6,8) 
| mad coordinates. 
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vectors and is called the normal vector. Therefore if the 
aircraft position vector is crossed into the vector normal 
to the DF bearing plane, a normal vector parallel to the 
surface of the earth is produced. This multiplication is 
carried out for the smoothed initial DF bearing, 9 (111), апа 
the filtered last bearing, 8 (n[n). Then if the bearing 
vectors are assumed parallel to the surface of the earth at 
the target position, their cross product will produce a 
vector through the center of the earth at their point of 
intersection. This vector is the position vector of the 
target. 

The assumption of the DF bearing being parallel to the 
earth's surface at the target and at the position of the air- 
craft can be easily understood when it is realized that the 
bearing vector is actually the projection of the plane con- 
taining the DF bearing onto the surface of the earth. 

The difficulty of the vector method arises when an 
attempt is made to describe the bearing vector in an earth 
centered cartesian coordinate system so the cross product 
can be obtained. This description is found by a series of 
three coordinate system rotations. The resultant of a suc- 
cession of coordinate system rotations is simply the dot 
product of the coefficient matrices of each rotation [1] 
and [9]. | 

The rotations made in this program are shown in Figs. 3, 
4, and 5. The original coordinate system is denoted (i,j,k), 


after the first rotation (i*,j*,k*), after the second 
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Figure 3. Rotation of Axes about j Axis. 


k*,k** 





i** 


Figure 4. Rotation of Axes about k* Axis. 
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Figure 5. Rotation of Axes About Local Vertical. 
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rotation (i**,j**,k**), and after the third rotation 
(i***,j***,k***), The first rotation about the negative j 


axis is expressed as 


1* cosó 0 sind т 
j*| = 0 1 0 j (24) 
k* -sinó 0 совф k 


The second rotation is about the k* axis and is represented 


by 
i** cos sino 0 i* 
j**| = |-sind σο5θ 0 j* (25) 
k** 0 0 1: k* 


t 
The resultant of the first two rotations is a target centered 
coordinate system expressed in cartesian coordinates. In 
this coordinate frame, i** is local vertical, j** is local 
west and k** is local north. 
The third rotation is a rotation by -a about the i** 
axis (local vertical) which after making simplifying trig- 


onometric substitutions is 


ixxx 1 0 0 i** 
uU Mi sina cosa 1. (26) 
k*** 0 -cosa sina k** 


Since k*** is the unit vector in the bearing plane, j*** 
is the normal to the bearing plane and after carrying out 
the indicated matrix multiplications, is expressed in terms 


Of the original coordinates as 
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N = j*** = (-sinasinO-cosasingcosé)i 
+ (sinacos@-cosasindsin§) j 


+ (cosacosd)K. (27) 


Then by cross multiplying the aircraft position vector 

associated with N, into N, the vector which represents the 
DF bearing vector is determined. This method was utilized 
in developing subroutine POSIT which is discussed in Appen- 


Ex C. 


E. EXTENDED KALMAN FILTER 

Since the Kalman filter is optimum only when the system 
differential equations and measurements are linear, a rela- 
tionship had to be found to linearize the nonlinear measure- 
ments associated with emitter locating. The sought for 
relationship can be obtained by a Taylor series expansion of 
the target location. This series expansion of the nonlinear 
measurements can be substituted for the coefficient matrices 
in the Kalman filter recursive gain equations and computation 
then proceeds just as in the discrete algorithm as described 
previously in this report. This employment of the Kalman 
filter is frequently referred to as the "Extended Kalman 
Filter." It is an intuitive but frequently successful appli- 
cation of the Kalman filter in the absence of truly optimum 
filters for non-linear systems [10]. 

These techniques are only approximate. They require 
that the disturbances, measurement noises, and uncertainties 


in the state be of such a size that the higher-order terms 
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ignored in computing the error are insignificant. It was 
felt that for this system, where one of the objectives was 
Simplicity of computation, that though the higher order 
terms are existent the system eier model used was a 
satisfactory approximation of the actual plant dynamics. 

In the case of emitter locating from an aircraft using 
the extended Kalman filter routine, we are actually filter- 
ing in latitude and longitude while our observations are 
noisy DF bearings only, i.e. 

Z(k) = 6(k) + V(k). (28) 
It is obvious that no pseudo-cartesian coordinates can be 
generated from this measurement. The non-linear measurement 
process must therefore be represented by a linear approx- 
imation. 

From the development of the Kalman filter equations [6], 


it can be seen that 
K(k|k) = 9(k,k-1) X(k-1|k-1) + E[X(k]x)|2(x)] (29) 


Let G(k)Z(k) = E[X(k|k)Z(k)] where 2(k) = M(k)X(k|k-1). So 


the estimated measurement equation becomes 


(к) = 8(k) (30) 
where [2] 
A = (A -λ) cos L 
xt: c (31) 
Im L 


where Àm is the target longitude, à is the aircraft longi- 
tude, Ln 15 the target latitude, and L is the aircraft 


latitude. 


25 





Substituting this expression into the Kalman filter 


equations, the recursive filter equation becomes 

X(k+1) = $ (k+1,k)X(k) + G(k)[9(k) - 8(k)]. (32) 
Expanding the measurement equation 

0 = M(A,L) | (33) 


about the most recent optimal estimate and ignoring higher 


waer terms results nn 


9 = M(A*,L*) + 99. A* o4 29 L*. (34) 








from which we see that 


_ [28 38 
a E E (35) 
The Kalman filter recursion equations, (7) through (11), 


may then be rewritten to include the nonlinear observation 


matrix M, and are given by 
P(k|k-1) - $(k,k-1)P(k-1l|k-1)ó (k,k-1) 4 Q(k) (36) 


G(k) - Р(к|к-1)м(к) |м(к) рок |к-1)м(к) + вск)| 7 (37) 


P(k|k) = P(k|k-1) - G(k)M(k)P (k|k-1) (38) 
X(k|k) 2 X(k|k-1) + G(k) (2(к) - м(к)Х(к|к-1)) (39) 
х(к|к-1) - Ф(к,к-1)Х(к-1|к-1) (40) 
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αυτ COMPUTATIONAL FY ROCEDURES 


А. NAVIGATIONAL DATA FILTERING - (SUBROUTINE NAV) 

The first step in the problem of finding a target is 
that of filtering the aircraft position estimates. Aircraft 
navigation data was sampled and recorded at discrete but 
time varying intervals. As stated in Section II, part B.l, 
only the position fixes were measured so the velocity is 
only estimated and is strictly a product of the model used 
to represent the aircraft. Since the aircraft position fixes 
were taken at random intervals, there are extended periods 
during which no navigation data is available and when the 
flight track could be altered drastically. Therefore, the 
-flight track is broken into legs to ensure that the program 
does not attempt to filter through these abrupt changes. 

The criteria used in this program to establish the end 
of a leg is a simple time test. If T(k), the time between 
navigation fixes, exceeds 120 seconds, the current leg is 
terminated and a new ee 15 initiated. 

Ifa leg was found to consist of three or fewer data 
points, that leg was neither filtered nor smoothed, but 
rather the measured data was used for the filtered and 
smoothed estimate of position, i.e., SLADSM(K)=ACLAD(K). No 
estimation of velocity was computed for these legs. After 
the entire flight track was divided into legs, the Kalman 


filter was initialized. 
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The navigation data filter consists of two nearly iden- 
tical Kalman filters, one to filter latitude and the other 
for longitude filtering. The system dynamics for the air- 
craft are modeled in each direction by a constant velocity 
plant. 

Since equal angles of latitude and longitude yield equal 
distances of movement only at the equator, a correction 
factor must be applied to angular measure as either pole is 
approached from the equator. 

At 60 north latitude, for example, one degree of move- 
ment in latitude measures sixty nautical miles while one 
degree of movement in longitude only measures thirty 
nautical miles. This requires that the longitude angular 
distance be corrected by the cosine of the locai latitude 
coordinate so that the two filters will have equal units of 
distance. The position estimates of the navigation data 


filters are based on estimated distances traveled, i.e. 
Х1 (к|к) = X1(k|k-1) + х1 (к|к-1) т(к) (41) 


The estimated changes in longitude position will be off by 


a value of 1/cos (latitude), so (41) was modified to 
X1 (k|k) = X1(k|k-1) + хі(к|к-1) T(k)cos (latitude) (42) 


- Equivalently, Х1 (к|к-1) can be reduced by the cosine of 
the latitude directly, which is the method used in this 


program. The equation used in NAV then is 


VELED (K)= (VELED (KK) + G2 (K) *ELON (K) ) *COS (SLA (K) ) (43) 
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where VELED is the aircraft velocity east in degrees per 
second, G2 is the Kalman filter gain, ELON is the Kalman 
filter error term and SLA is the latitude coordinate of the 
aircraft. The same correction is applied to the smoothed 
X1 (k) term, VELEDS, in the smoothing filter. 

To initialize the latitude filter, the initial position 
estimate, SLAD(KI), was set equal to the first measured 
position, ACLAD(KI). The aircraft velocity was not observ- 


able, so the initial velocity was estimated by 
VELND (KI)=(ACLAD (KI+1) - ACLAD(KI))/T(KI+1) (44) 


where T(KI+1) is the time increment from time KI to time 
Reit]. X(1| 0) was assumed equal to x(0|0) so SLATD(KI), the 
predicted value of SLAD, was also set equal to ACLAD(KI). 

The longitude filter was initialized in the same manner 
as the latitude filter with the only change being that the 
velocity east was corrected by the cosine of the latitude 
to correct for the curvature of the earth as discussed above. 


Therefore 


VELED (KI)=((ACLOD(KI+1) - ACLOD (KI) /T(KI+1) ) 


X COS (SLA (KI) ) (45) 


The initial uncertainty of position and velocity on 
filter initialization was accounted for in the initial values 
of the error covariance matrix P(1|0). The error in the 
initial position fixes by the navigational computer were 
assumed to be very small and so the initial covariance matrix 


P(1|0), was set equal to the identity matrix. 
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The measurement noise, v, 1S assumed scalar so by (3) 
Е vv" | = (46) 


The sat of R will change for each system, depending upon 
the accuracy of that system, but it is assumed constant for 
each data set. 

The smoothing filter is recursive in negative time so 
the first estimate of position computed by the ENS 
filter is the next to the last fix in that leg. Therefore 
to initialize the smoothing filter, the first smoothed 
estimate SLADSM(N), was set equal to the last filtered posi- 
tion estimate SLAD(N). The error covariance matrix P, used 
to compute the smoothed position estimates is the same 
matrix computed for the Kalman filter, so there was no P 
matrix to initialize. 

It was found that occasionally the aircraft navigational 
computer would produce a totally erroneous position fix, to 
check for this occurrence, each Kalman filter error term, 
E(k) = Z(k) - Х(к+1|к), was checked and if it exceeded a 
certain value, denoted test, the data point was rejected. 
The e ol the state, Х(к+1|к), was inserted as the 


estimate of position, i.e. in the latitude filter 
SLAD (K)=SLAD(K-1) + VELN(K-1)T(K) (47) 


The equations used in the navigation data filter 


SUBROUTINE NAV) are derived in Appendix A. 
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В. ANGLE FILTERING - (SUBROUTINE GEORGE) 

After the navigation data is filtered and smoothed the 
processing switches to subroutine GEORGE, which is basically 
the program presented in [2], This subroutine sorts the 
emitter data and then filters and smooths the DF bearings. 

To adapt the program presented in [2], for use in this 
problem, the data sort routine was changed, a new smoothing 
filter was inserted and the emitter position locating 
algorithm was replaced by a vector solution method which 
is included in subroutine POSIT. 

The data sort used in this program is shorter than the 
Original routine. In the data sort routine, the error 
interval associated with the measured values of signal 
frequency and PRF was opened up to approximate the errors 
of the system being simulated. This test interval can 
easily be changed to any desired width to fit the system 
being simulated. 

It was found that the PRF value was zero in some data 
sets. In these cases, the DF bearing associated with these 
particular points mere correlated with the previous signal 
with the same carrier frequency. 

All of the DF bearing angles are checked for target 
correlation as in [2], but instead of discarding any data 
points which do not pass the test E? (K) « (P11(K) е 
RCUT)*TSTCUT, being discarded, they are assigned to a new 
target.  RCUT is the assumed value of the variance of the 


measurement noise v, and TSTCUT is a multiplier to vary the 
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size of the gate. This routine was inserted because with 
the method used in [2], only one target of each FREQ and PRF 
could be processed from each data set; data from all other 
similar emitters were discarded. 

The smoothing routine utilized here is shorter and does 
not require the computation of the inverse of the P matrix 
as was required in [2], since computing the inverse of a 
matrix consumes a lot of computer time. The smoothing 
filter equations used are derived in Appendix B. 

After each DF bearing, THTD(K), is filtered and the 
first DF bearing, THTD1(k), is smoothed based on all succes- 
sive bearing estimates, a test is made to determine if 
processing should be switched to extended Kalman filtering, 
which is done in subroutine EXTEND. This test compares 
P11(K) with the product of EXTEST and RCUT, where EXTEST is 
a multiplier to vary the size of the gate. If EXTEST is 
set equal to zero, the processing will always stay in the 
angle filter. As EXTEST is increased the processing will 
switch to EXTEND earlier and earlier in the data sequence 
but the initial ие of the target position used to 
initialize the extended filter will be worse, as will the 
initial value of the P matrix in the extended filter equa- 
tions described in part F of this section. 

If it is decided that all of the DF bearings correlated 
to a target will be angle filtered, GEORGE calls subroutine 
PREPARE which in turn calls subroutine POSIT which computes 


the emitter location based on the DF bearings THTD1 and 
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THTD directly. These subroutines are discussed later in 
this section. 

The value of the multipliers of both tests in GEORGE, 
TSTCUT and EXTEST, are calling arguments for the subroutine 
so they can be controlled by the main program. 

All of the Kalman filter initializations for GEORGE 
are discussed in [2]. The fixed delay smoothing equations 
are initialized with the initial smoothed estimate THTD1(1), 
being set equal to the initial filtered estimate THTD (1). 
THTD(1) was set equal to the measured value of the first DF 


bearing, THETAD(KI). 


С. SUBROUTINE PREPARE 

When vector products are used, the order of multiplica- 
tion is critical; if the order is reversed, the resultant 
will be reversed. In the problem of emitter position 
locating, a reversed resultant will produce a fix on the 
opposite side of the earth.  PREPARE is written to prevent 
this occurrence. First the direction of the track of the 
aircraft is computed. | Then THTD and THTD1 are checked to 
determine on which side of the track they lie and ensure 
that they both lie on the same side of the track. If they 
do not, no position fix is calculated. If they do lie on 
the same side of the track, they are checked to see if they 
cross. If not, no fix is computed.  PREPARE then computes 
the calling arguments for POSIT - ACLAD, ACLON, and THD. 
ACLAD and ACLON are the latitude and longitude coordinates 


respectively of the aircraft at the times the two DF bearings 
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were recorded. THD contains the direction of the two bear- 
ings ΤΗΤΡΙ and THTD. In so doing, it ensures that the DF 
bearing with the larger angle of arrival is crossed into 
the bearing with the smaller angle of arrival and not vice 


versa. PREPARE is also called by ELIPS6 and EXTEND. 


% 


D. COMPUTING INITIAL POSITION - (SUBROUTINE POSIT) 

POSIT then computes the desired location by the method 
described in Section II, part D. First the bearing vectors, 
е (1 n), and Ө (п[а), are expressed in the earth centered 
cartesian coordinate system. Then the cross product of the 
two bearing vectors is computed giving the target vector in 
X, y, Z coordinates. These coordinates are converted to 


latitude and longitude coordinates by 


χα. 
ТТАР = ТАМ? (48) 
х12+х2 
-1 | x2 
ШОЮ = ТАМ — 49 
T S (49) 








where X1, X2, and X3 are the X, y, Z coordinates respectively. 
An example illustrating the method used to find the target 


vector is given in Appendix C. 


E. DEFINING THE ERROR ELLIPSE - (SUBROUTINE POINTS) 

If it is decided that the data should be processed by 
the extended Kalman filter, POINTS is first called. POINTS 
uses POSIT to compute the intersections of the edges of the 
cones of error associated with THTD and THTD1. These points 


are shown in Fig. 6. POINTS ensures that PTLAT(1,I,J), 
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Figure 6. Target Position Error Covariance Ellipse. 
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PTLON(1,I,J) is always the intersection closest to the 

flight track and it determines if the DF bearings THTD1 and 
THTD do in fact cross. If they do not, it makes sure that 
EXTEND is not called by returning to the calling program at 


a point after the EXTEND call. 


F. EXTENDED KALMAN FILTERING - (SUBROUTINE EXTEND) 

In linearizing the system by using a Taylor series expan- 
Sion, it was assumed that the M matrix would be fairly con- 
stant over the range of uncertainty of x, therefore the 
initial value of x, x(0), must be a good approximation of 
the true value of x or the filter can diverge. To find an 
initial estimate of the true value of x, the DF bearings are 
first angle filtered in subroutine GEORGE. When the 
covariance of error of the current bearing estimate, P11(K), 
becomes less than EXTEST times the variance of the measure- 
ment noise, RCUT, the processing is switched to the extended 
Kalman filter routine, EXTEND. 

EXTEND calls PREPARE for an initial estimate of the 
target position coordinates, TLAD, and TLOD. EXTEND then 
ЕЕ putes the semi-major axis, a, and the semi-minor axis, C, 
of the error covariance ellipse described by the coordinates 
from POINTS and centered at the coordinates computed by 
PREPARE. 

The length of the semi-major axis of the NE cu ME 
was assumed to be the distance from the initial target loca- 
tion, TGT, to the intersection of the error cones closest 


to the flight track. These points are shown in Fig. 6. 
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The length of the semi-minor axis is found in the following 
manner. 

The distance from the target position, TGT, to point 3 
and Ec distance from TGT to point 4 are computed. The 
projection of the average of these two distances on to a 
line perpendicular to the semi-major axis is the length of 
the semi-minor axis. 

The orientation of the error ellipse on the surface of 
the earth is taken to be the amount of clockwise rotation of 
the semi-major axis from the meridian passing through the 
center of the ellipse. 

A and c uniquely describe an ellipse in an x' y' coor- 


dinate frame according to 


Za .- 
> + 5 = (50) 
C a 


The x'y' system is rotated by an angle (90-a) degrees from 
the xy system in which the extended Kalman filter functions. 
The x and y axes correspond to longitude and latitude 
respectively on a flat earth model. The extended Peer wi Te 
find an optimal estimate of the coordinates of the emitter 
position in the xy system. To describe the error ellipse in 
the xy system, a coordinate system rotation was made accord- 


ing to the transformation matrix. 


(51). 


x cosa -sina t 
y 


y ısina cosa y 
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After performing this transformation and making simplifying 
trigonometric substitutiens (see Appendix D) the initial 


values for the covariance matrix P, become 


Р11 (КТ) = (A nob 4 (C cosas (52) 
22-2 
Р12 (КІ) = (А -С”) sinacosa (£3) 
2 š 2 
22 (KL) 4<-- (А созо fF (C Sino) (54) 


Using (31), EXTEND computes an initial estimate of 6, 
TX, which is used to compute the initial extended filter 
error term, ER(KI)=THETA(KI)-TX(KI), where THETA is the 
measured DF bearing angle in radians. The initial gains 
associated with the nonlinear measurement equation are found 
from (37). The initial estimate of longitude, XTD, is set 
equal to TLOD, and YTD, the initial value of latitude, is 
set equal to TLAD. 

The initial inputs to the linear longitude and latitude 
filter, XTDl and YTD1, are then found by substituting (11) 


into (10), rewritten as 
XTDI(KI)SXTD (KI) (КТ ЕВ (КТ) (55) 
ҮЛГІ ae (KI) + GY(KI)ER(KI). (56) 
Then the outputs, XTD and YTD, of the linear fl tet se are fed 
into the linearized filter and the process proceeds as 
described for initialization. 
The longitude and latitude filter equations are identi- 


cal to the corresponding filters in subroutine NAV except 


for notation, as listed in Appendix A. 
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The Ф па гах for the linearized measurement filter is 
the identity matrix since the states of this filter are 
longitude and latitude only. 

On seach! есите оп off the £rlter tha error term ER, tis 
compared with a gate identical to the correlation gate in 
subroutine GEORGE. Any DF bearings failing the test are 
assigned to a new target and are processed either in the 
angle filter or in EXTEND on a later call of the subroutine. 
The extended Kalman filter equations are derived in Appen- 


dix D. 
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TVE RE SENTARTONSOP RESULTS 


The Monte Carlo simulation developed in [2] was utilized 
to accomplish program validity and error analysis studies. 
The scenario developed for that simulation was of an aircraft 
flying south along the 118°W meridian at a ground speed of 
600 knots and with heading of 180°. Bearing angles-of- 


arrival were recorded from two VORTAC stations located at 


Emitter 1 Oceanside VORTAC 33. 2405294 
117.41694°W 


Emitter 2 San Diego VORTAC 32.78222?N 
117.22444°W 


DF cuts and aircraft position fixes were recorded every six 
seconds alternately from each target giving a uniform 
sampling interval. Known true bearing angles were computed 
numerically from the aircraft position coordinates and the 
emitter position coordinates to obtain a very accurate data 
base. The DF cuts obtained are shown in Fig. 7 for emitter 
1 and in Fig. 8 for emitter 2. 

Normally distributed, zero mean random noise with an 
assumed variance of 1 was added independently to the lati- 
tude fixes, longitude fixes, and angles-of-arrival. The 
errors in aircraft heading and angle-of-arrival were combined 
into the single angle-of-arrival error. The flight track 
and noisy DF bearings are shown in Figs. 9 and 10 for emit- 


ters l and 2 respectively. 
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Figure 7. Lines-of-Bearing on Emitter l. 
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Figure 8. Lines-of-Bearing on Emitter 2. 
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Figure 9. Noisy Lines-of-Bearing on Emitter l. 
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A. ERROR ANALYSES 

A large number of simulation runs were executed to 
obtain a statistically valid error analysis, where each 
run constituted a complete mission. The results of these 
analyses are given in Appendix E and are summarized below 
for the two simulation emitters. 

The results of the error analysis of the navigation data 
filter are listed on page . The average of the noise 
added to the positions is shown as is the mean-square value 
of that noise. By comparing the listed mean-square error 
of the nosi IPE with that of the noise, it can be seen that 
the model utilized in the program has a bias which develops 
after a large number of runs. Each run is a complete flight 
of 61 position fixes, so the result after 45 runs is the 
statistical average of 2745 data points. The results of 2, 


10, 45, and 50 runs was found to be 


LATITUDE LONGITUDE 
Runs Mean-Square Mean-Square Mean-Square Mean-Square 

Noise Έτος Noise Error 
2 .427 . 326 1.80 1.227] 
10 .937 1.02 1.24 1.16 
45 1.26 1.07 1.19 2 
50 1.19 1.31 I: 1:23 

8 


The units for this list are degrees times 10 ~. The error 
associated with each individual position fix on a single run 


is shown on page ; 
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For the analysis of the angle filter, a range error was 
computed from each estimated emitter position latitude error 
and longitude error, and all errors were statistically 
averaged for the total number of runs. 

The longitude error which is perpendicular to the flight 
path was found to beEmuch larger than the latitudewerror. 
This result agrees with the theory used to develop the 
ellipses which describe the initial covariance matrix for 
the extended Kalman filter. This result also agrees with 
the final orientation of the target error ellipses as shown 
on page 51 and 52. The results of this analysis are sum- 


marized below for 50 runs. 


AVERAGE AVERAGE AVERAGE 

LATITUDE LONGITUDE RANGE 

ERROR ERROR ERROR 

EMITTER 1 „684 J 129 1.51 
EMITTER 2 .685 1.870 2.098 


The units of the above table are nautical miles. 

The results of the error analysis of the extended Kalman 
filter are shown on page 73. The errors of each individual 
flight which are listed on that page point out the dependency 
of this filter on the accuracy of the initial estimate of the 
emitter position. Since the initial estimate is based on 
only four DF bearings for this simulation, this estimate is 
heavily weighted by the noise added to the first bearings and 


the rate of convergence of the filter. The results of the 
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analysis of the extended filter are given below for 50 runs 


with the units being nautical miles. 


AVERAGE AVERAGE AVERAGE 

LATITUDE LONGITUDE RANGE 

ERROR ERROR ERROR 
ЕШИТТЕК 1 Ш 535 4.654 4.988 
EMITTER 2 972 7.784 7.876 


В. COMPUTER PROCESSING OF SIMULATED DATA 

A series of plots showing the ability of this program to 
locate target positions in the absence of noise starts on 
page 50. The number in the lower right corner is the number 
of the DF bearing estimate associated with that target which 
was used to compute the target position and error ellipse in 
that plot. The plots on page 51, 52 and show the four 
points of intersection computed by POINTS which describe 
the error ellipse. From these plots, it can be seen that 
the error ellipse does accurately describe the area of the 
probability region associated with each position fing 

The output of a single run of the program using the 
simulated data starts on page 76. The first run assumes 
that processing will be strictly by the angle filter. The 
output of a run in which the extended filter was utilized 
starts on page 110. Plots of the error ellipses associated 
with the covariance matrices of each filter are included in 
the output. 

These series of plots show the change of orientation of 


the error ellipse as the aircraft progressed along its flight 
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path. They also illustrate the decrease in area of the 
ellipses as more data is collected and as the angle between 
the smoothed initial bearing 8 (1/N), and the filtered final 
bearing 0 (N/N) increased. 

By comparing the plots of the ellipse associated with 
the angle filter on page 50 and the plot on page 53 associa- 
Bed with the extended filter, it can be seen that the 
extended filter is initialized with the same error covari- 
ance as the angle filter. 

Further comparison of the two series of plots shows that 
the position of the centers of the ellipses produced by the 
angle filter are much more erratic than those of the extended 
filter. This indicates that the angle filter has a faster 
response to each new bit of data than the extended filter. 
The response may seem too fast, but in order to have a rapid 
rate of convergence of the filter so processing could switch 
quickly to the extended filter, fast response is necessary, 
so this is a compromise. 

The slow response of the extended filter is shown by 
the relatively slow m of rotation of the error ellipse. 
The slow response is desirable to prevent the filter from 
converging too rapidly onto a wrong point if it is initial- 


ized with a poor initial position fix. 


C.  AIRCRAFT FLIGHT DATA PROCESSING 
The output of a computer run using data from an actual 


flight starts on page 144. The effectiveness of the data 
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sort routine is shown by the lists on page 146 and 147. The 
first list is the result of the sort on PRF and FREQUENCY 
only. The second list is the final correlation after the 


data has been correlated to targets using the test discussed 


on page 31. 
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Figure lla. Error Ellipse in the Absence of Noise. 
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ROT OF ERROR COVARIANCES OF EXTENDED KALMAN FILTER 
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CONCLUSIONS 


The fact that Kalman filtering of digital data works is 
nothing new, many examples can be conre in the literature. 
This report has shown a particular application of the Kalman 
theory and presented a program which E work in that 
application, i.e. the processing of airborne DF information. 

There are several areas of this study which need more 
research and testing. А more complete model for the navi- 

| 
gation filter could be developed which would reduce the bias 
present in the one utilized for this report. Then it should 
be determined if the bias is harmful or not and if it is 
worth the resulting increases in computer processing to 
remove the small error. The response of the two emitter 
position locating filters should be i at to determine 
if there is a more optimal Q for both schemes. 

A program for plotting the error ellipses of each target 
for each filtering scheme was presented. This program 
ES aes a сайын ту for displaying овации са ту the effect 
of varying the different parameters which are inputs to the 
subroutines, plus the effect of varying filter response time. 

Many current elint systems have a digital computer as a 
link in their processing chain, but it is used strictly as 
a device to plot the data and no attempt is made to compute 


an optimal emitter location solution. By implementing this 
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Kalman filter program, the effectiveness of the elint system 
could be greatly enhanced by reducing manual processing time 


and produce more accurate target position coordinates. 
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APPENDIX A 


DERIVATION OF SCALAR KALMAN FILTER RECURSION EQUATIONS 


The Kalman filter equations for all of the linear models 
in this program can be derived in the same general form 
described below. The variable names used in each individual 
subroutine to represent the general terms in the derivation 
are listed at the end of this section. 

The Kalman filter recursion equations from page 10, (7) 


through (11), are listed below: 


EIA er MES ον (1A) 
G (k) - P(kIk-2)EGO T E OO P (kl k-2) E (e T € RO)1 T (2А) 
P(k|k) = P(k|k-1) - G(k)H(k)P(k|k-1) (3A) 
K(kik) = Кик 1) + ск) [z(k) — н (к) Х(к|к-1)) (4А) 
х(к|к-1) + ф(к,к-1) Х(к-1|к-1) (5A) 
| 1 T (k+1) 
where in this application $ф(к+1,К) = : | ; 
Н(К) = [1 01, 


the P and Q matrices may be considered to have scalar com- 


ponents given by 


Pll P12 О11 Q12 
and respectively, 
P21 P22 Q21 (022 
Gl 
and the G matrix is a 2xl matrix of the form 
G2 
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Writing (2A) in matrix notation yields 


A | а е ето fie E 

= [1 ο) В ; (6А) 
G2 P21 P22 0 j P21 P22 0 
ШІСІ Рот the observation matrix H(k) = [1 οἱ, the inverse 


term becomes a scalar allowing the gain terms to be computed 


directly as is shown below: 


ci Pll = 
= [P11 + 4 (7A) 
G2 P21 


which results in the scalar gain equations 


о 2 Р11(К]к-1) 
E = PERO E 


G2(k) = Sol PE (9A) 


Р11 (к!к-1) + R(k) 


let the P matrix be defined by 


2 ^ T 
P(k/k-1) - E [o (x) - G(x]x-1)] [o (x) - $«Ix-1)] (10A) 


from which it can be seen that since 9 and % аге statisti- 


cally independent,’ where 


then P12 = P21, and the P matrix is symetric. From (15) it 
can be seen that the Q matrix is also symetric. Equation 


(9A) then becomes 


РК №) 


ex Der 


(11A) 


To solve for the prediction covariance terms, (3A) was 


substituted into (1A) giving 
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DINE 
poo 52 
k|k-1 


PIL 


Р12 
k 


Р12]||1 0 

+ 
Р22 Tal 
|k-1 


VARIABLE NAMES USED IN PROGRAM TO REPRESENT 


VARIABLES IN 


P11 P12 TOES P11 
Р12 'P22 Qj c P12 
k-1|k 
General 
Variable R P 
Subroutine 
Name 
NAV RNAV SP 
EATITUDE 
LONGITUDE 
GEORGE RCUT P 
EXTEND EXTEND EP 
LATITUDE 
LONGITUDE 
LINEARIZED 
MEASURE- p 
МЕКТ 


P G 
SPKK SG 
= G 
= G 
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SLAD 
SLOD 


THTD 
XTD 
XTD 


XTDl 
YTDL 


VELED 
VELND 


TDTD 


XTDDOT 
YTDDOT 


GENERAL DERIVATION 


SLATD  ELAT 
SLOND  ELON 


ΤΕ ΤΟ 19 


ХТОНАТ ЕХ 


ИТрНАТ ЕН 


ЕК 
ЕК 


ТХ 
TX 


Oz 
Q12 Q22 


(12A) 


ACLAD 
ACLOD 


THETAD 
XTDl 
BD. 


ТНЕТА 
ТНЕТА 





APPENDIX B 


DERIVATION OF SMOOTHING FILTER EQUATIONS 


A. FIXED POINT SMOOTHING 
The equations used to smooth the estimates of the first 
DF bearing, THTD1, for a given target are listed on page 15 


and are repeated below with k = 1. 
te Filter Equation 
^ : 2 "То A 
x(1|j) 2 X(1(551) + ОЗНО) во 03) [2 09) 
- &3)6G,3-22x G-1| 3-1) (1B) 
where j = 2,3,..., and the initial condition is Xx (111). 
2. Gain Equation 
W(j) = W(j-1)4(3,j-1) 7 r-s(3)P(3|3)] (2B) 
i Mo cw 
where W(1) = P(1|1) and S(j) = H(j) R ^ (3)H(3) 
3. Covariance Equation 
Р(1|3) - (13-0 - №03) [5030р 0313-10503) 
E el 
+5 (3) | и (9) (3B) 
where the initial condition is Р(1[1). Р (3 |3) апа Е =) 
are the error covariance matrices from the optimal filter 
and predictor respectively. Since H = [1 0] and R(j) is a 


scalar, these matrix equations become scalar expressions. 


To compute a smoothed estimate of Х(113), it is) first 


necessary to solve (2B) for the values of the gains to be 


used in (1B). 





Hirst solve stor S (3) 


т 1/R 0 
s(j) =| | = [1 0] = (4B) 
0 0 0 
Then noting that 
1 ο 
$(3,3-1) - (5B) 
T(j 1 


Equation (2B) becomes 


W1l W12 W11 W12 1 O 1 0 l/R 01] P11 P12 
= = = (68) 
W21 W22 W21 W22 Π.Ι 0 1 _ 0 ο PIF P22 
2573) ΕΞ. БЕЛІ 
TO solve (1B) first note that 
і Д 1 T a 
2(3) = H(310%(G-1/3-1) = [1 JIM = ху + Хут (7B) 


so therefore let E (3) =2(3)-X, (9) -%, C) TO). Then in the 


notation used in the program 


THTD1 THTD1 ОРИ t 
= | + ші); 1 (8B) 
TDTD1 THTD1 w21 #2210| Е 
(αλ) 3 — в) 


The error covariance matrix for the fixed point smoothing 


Filter is 


pil D12 
D = (9B) 
D2 Ρ22 


so (3B) written matrix form is 
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Sil pl2 DSD? Wll W12 I/R OFP? 


mol D22 Ρο D22 w21 W22 0 ορ... 522 
(1]3) (1}4-1) 
1/R 0 1/R 0 W11 W21 
+ (10B) 
0 0 0 0 W12 W22 


B. FIXED INTERVAL SMOOTHING 
The fixed interval smoothing equations are listed on 


page and are repeated below. 
ШІ ЕТ гег Есшаътой 


Я(к|п) < X(x]x) + A(x) | (ка) - ἃ κει|κ)) (11в) 


ЕЕ К = n-l1,n-2,...,0, where € (n|n) is the boundary condi- 


шоп tor k = n-l. 


2. Gain Equation 


A(k) = Р(к|к)ф (к+1,к) ТР 1 (к+1|к) (128) 


3. Covariance Equation 


P(k|n) = P(k|k) + A(k) | P(k+1|n) Е Р (к+1 |) | д(к) 7 (13B) 


The covariance equation is not used in the computation of 
the smoothed estimate of X (k|n) or filter gain A(k), so it 
was not utilized in the program. 

First the values of the gain matrix A, are computed. 


a 


Using the notation PIN=P ~ (12B) becomes 


All 212] [Р11 P12][1 O][PIN11 PIN12 
y (14B) 
A21 a22| |P12 P22||T 1||РІМІ2 РІМ22 


where P(k|k) and Р (к+1 |к) are the covariance terms from the 
optimal filter equations and the fact that P12-P21 is 
utilized. 
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Again letting E(k) = 


(11B) becomes 


х(к+1 |а) - H(k)6 (k*1|k) X(k|X) , 


X(k|n) 9 X(k|X) + А(Ж)Е(К) (15B) 


and (11B) is written in the notation used in the program as 


SLAPSM | | SLAD All 
: + 
VELNDSM | VELND A21 


and 


SLODSM SLOD All 
= + 
VELEDS | |VELED j| |А21 


A12 
Br (16B) 
A22 
A12 | 
| ELoN1]. (17B) 
A22 
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APPENDIX C 
DERIVATION OF THE VECTOR METHOD 
POSITION LOCATING ALGORITHM 
This algorithm is divided into three basic sections; 
(A) computation of normal vectors to the bearing plane, (B) 
computation of bearing vectors, and (C) computation of the 


target position vector. 


A. COMPUTATION OF THE NORMAL VECTOR TO THE BEARING PLANE 
The normal vector of the bearing planes are computed as 
described in Section 11,D, using the aircraft latitude and 
longitude (4,80), and the DF bearing angle а. 
The bearing plane has the equation dxx + dyy + 922 < 0. 


The normal vector, N, can be written in the form 
N = dxi + dyj + dzk (1С) 


where i,j,k are the unit base vectors in the x,y,z 


directions. The components dx, dy, and dz, of normal vector 


N correspond to the coefficients found from (27). That is 
dx = -sina sind. - cosa cos$ sind (2C) 
ау = ѕіпа соѕ Ө - соѕа ѕіп ө sino ec) 
dz — cosa cos à (4C) 


B. COMPUTATION OF BEARING VECTOR 
Let SI(x,y,z) = xI + yj + zk denote the aircraft position 


vector. The cross product of SI and N produce the vector 
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Perpendicular to the plane offboth SI and N®which is?the 


bearing vector D(I), thus 


1 j k 


i 
un 
H 
я 
= 
lI 
м 


D (I) y 2 (5C) 


dx ду dz 


so that D(I) А(Т)1 * B(I)j T. C(I)K, I-1,2, where 


А ="YEX DZ 228b (6C) 


B-z xDX- xx DZ (7C) 
С = Хх DY = у ХХ. (8C) 


mien each of the vectors is normalized to determine the 


length of the unit vector by dividing by D where 
D ЕД + в? + с2 2 (9С) 


ЕЕ COMPUTATION OF THE TARGET POSITION VECTOR 
The two bearing vectors D(1) and D(2) are cross multi- 
plied to find the x,y,z coordinates of the target vector. 
So 
x y 2 
Χώρο) ιν АТ CL E (10C) 


А2 В2 C2 


The algorithm for finding the target position vector is 


therefore 
Xl = BI x С2 ο ο (11C) 
X2 = A2 x Cl - Al x C2 Й (12С) 
x3 -АПГХБ2 p y p IE: (13C) 
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This vector is normalized to a unit vector with one unit 
being the radius of the earth. 
To find the latitude and longitude coordinates of the 


target position the following equations are used 


TLAD = carm A RR (14 ) 


X12 + x22 


-1 | х2 


TLOD X1 


It 


tan (15 ) 
D. EXAMPLE OF VECTOR METHOD FOR LOCATING TARGET POSITION 

A DF bearing of 30 degrees is taken when the aircraft is 
at latitude 30 degrees north and longitude 45 degrees east. 
A second DF bearing of 60 degrees is taken from the same 
emitter when the aircraft is at 3l degrees north and 45 
east. 

1. First find the normal vector to the bearing plane by 
substituting the values of d, 0, and a into (2C) through 
(4c). 


-sin30 sin45 - cos30 cos45 sin30 = -.6597 


It 


DX 
РУ = $11030 cos45 - cos30 sin45 sin30 = .0473 


DZ 


N 


cos30 cos30 = 2750 


2. Using (21) through (23) find the’ x7y, and con 


ponents of the aircraft position vector. 


x = cos30 cos45 = .6123 
y = cos30 sin45 = .6123 
z = sin30 = .500 
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3. Next find the bearing vector, D(I), which is the 
cross product of the aircraft position vector and the normal 


to the bearing plane, using (6C) through (8C). 


A AS 750 50 x . CMF SW = 4356 


Bl O = БО 2612358 750. 2, —, 7872 


Cl = ІЗ аа ЗГЕ СІ23 221-6597) %-..,4329 


4. Find the value of D that will normalize D(I) to a 


unit vector. Using (9C) 


D = SS LS O 17:0 


Therefore, the bearing vector is already a unit vector. 

5. Similarly the corresponding values for the second 
bearing are: DX = .7944, DY = .4302, DZ = .42855, x = .6061, 
y = .6061, and z  .5150. 

6. Since the angle of arrival of the second DF bearing 
is larger than the angle of the first bearing, the second 
bearing must be crossed into the first to obtain the outward 
pointing position vector. Therefore from (9C) and (11C) 


through (13C) 


Xl] -m 5566) х 1329 Eule. 7692) 22. 741229272962 
X2 = „4356 х .7422 - .0381 x „4329 = „3068 
ХЗ = 20381 х (=.7892) - 1356 909 6031) 9— «2613 


D= |.0877 + .0941 + .0682 - .50 


7. Find the longitude and latitude coordinates of the 


target position using (14C) and (15C). 
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TLOD 


ARCTAN (.6136/.5924) 


li 


46.0 degrees 


TLAD = ARCTAN (.5224/7. 8529) 31.5 degrees 


The computer solution to this problem was TLOD = 46.01540 


and TLAD = 31.49590. 
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APPENDIX D 


DERIVATION OF EXTENDED KALMAN FILTER EQUATIONS 


А. ERROR COVARIANCE EQUATION INITIALIZATION 

The ellipse described by the Pll and Dll terms in the 
angle filtering routine lies in the X'Y' coordinate system 
which is rotated counter-clockwise (90 - a) degrees from the 
XY coordinate system used in the Extended Kalman Filter. To 
determine the values of the axes of the ellipse in the XY 
coordinate system, the transformation T, described by (51) 


was utilized. 


cosa -sino 
sina cosa в 
Let the semi-major axis Бе А" - E[X' - X'], and the semi- 
Major axis be C' = E[Y' - Y']. Define Z = TX where 
EI = [А c'], then the error covariance matrix P, in the XY 
frame is 
р = е [2 z | = т Elx x Jr. (2D) 


Writing this equation in matrix form yields 


— 


Pll P12 cosa  -sina||A' cosa sina 
= ES с) (35) 
(p 


P12 P21 sina cosa -sim cosa 


Carrying out the indicated matrix multiplications in (3D) 


produces (52) through (54) which are repeated here. 


Р11 (КТ) = (А n + (С EL (4D) 


πα. 


—- 





2 2 


Ελ ο Кт) #- Iino Соса (A = Cm) (5D) 


P22 (KI) (А Eo (C uno» (6D) 


B. LATITUDE AND LONGITUDE FILTER EQUATIONS 

The block diagram for the filter system used in subrou- 
tine Extend is shown in Fig. 1. As stated in Section III, 
part F, the latitude and longitude filters are identical to 
the corresponding filters used in Subroutine Nav to compute 
the optimal aircraft position estimates. The recursion 
equations for these filters are derived in Appendix A with 
the variable names utilized in this subroutine being listed 


at the end of Appendix A. 


С.  LINEARIZED MEASUREMENT EQUATIONS 

The extended Kaiman filter recursion equations (36) 
through (40) are similar in form to the basic Kalman filter 
recursion equations on page , except that the observation 
matrix is a nonlinear transformation matrix M as defined by 


(35) where 


^ 


cD > 


9 9 98 
M(k) - = | = 
E A OL 





9 ды 
к лена (рмх DMY | (7D) 


ж> 


Taking partial derivatives of (31) yields 


(L_-L) cos L 
DMX = zu: nml Cá oe (8D) 


Q2 
Ф >» 





Q2 
> 





2 2 2 
T (L.-L) + (ATA) cos Ly 
46 - Ani) | (LD) SinL, + созі, | 
МУ ee И 
Т (L, =L) + (АА) cos Lip 
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These terms are computed numerically and substituted into 


equations (36) and (37) which are rewritten in matrix form 


as 
εχ) [511 P12][DMX pii ῬΙΖ]ΓΌΜΧ -1 

= | рмх pay | +R (105) 
сү | | P12 P22| DMY P12 Р22|| рму 
апа 
ШЕШ 12| (т olei n21 o] 211 012 

= + (11D) 

P12 522)! |0 1112 Ῥ22||0 11 1012 022 

к+1 [к k|k 


Equation (38) is then substituted ineo TOD); however, the 
fact that the $ matrix is the identity matrix considerably 
simplifies the recursion equations since they are no longer 
dependent on the sampling interval T(k). Since the gain 
terms are computed as a function of the nonlinear terms DMX 
and DMY, it is essential to have the correct units for the 
error term ER(k). In this case the units of gain are not 
dimensionless but degrees per radian, so the то term 
must be given in radians to update the target position 
estimates in degrees of latitude and longitude. 


Equation (40) is substituted into (39) and written in 


the notation used in the program is 


XTD1 (k) XTD(k) + GX(k)ER(k) (12D) 


and 


YTD1 (k) 


YTD(k) + GY (k)ER(k). (13D) 
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APPENDEASE 
MONTE CARLO SIMULATION ERROR ANALYSIS 


me TIMATED AIRCRAFT POSITICN ERROR IN DEGREES LATITUDE 


LONGITUDE 


LATITUDE 


cn co «fF caro «rx LO slc «rU sr On aco «xU rr Uo (cn ens to sr eo «rx СО en esr «o rro 


МСО СЧС ШУ ШУО С) у О ЧУСУ сло ОО Ко соо Осо ФО О чо О О соо EA 

-О ч чоо Сч “У САМ С СО О со СОСО ocu or oejd uem 0 © СГ СГ со СУГ © С > Ао t 

41440 СУ ч О М Мар СУ г ——=— x G СООСУ СО О АСОМ СО ч СЈО оо СУ чс) ОУ СМ СМС ч 

e @ @ o @ ә е е е G 9? ее е е % е е % ϱ 0 ϱ 6 9 o0 @ ео е % @ o @ @ ὁϱ @ 0 0 06 0 0 ? o 8 

x: сесеоссеососвосоесвосососафоо с 
| ! | | | | 11 | | 


CV са SPOS Е ЗЕЕ С Een xr en e xr sb СО СОР ШУ СО РЁ СО СО СО СҮ СП СОЁ ч СО СО) 
РТТ 
| | | | | 
DU US UU U UJ uu UU U QW U u U u U A Uy U U u оли вала Ui UJ uu U U US U LG uu UU uu U U Wa Wa us pL 
(000 «OQ C 00 O Lo (0 UU UY LO LO (8 a9 СО СМ (Сү СУ СС со СО О СУ СО О оо О (eun Uie UJ CO Ot ў СОМ О 
sS (NM MA LAR LA LAO NN a ILU CO meo — © са ХО $ со О С со uem -O0 um 9 FOO NO 
e cO 0J 3 ΟΙ ώς πώ Sd 00 A - Oe ч А 64-09 0J0 UST ec IAesdv eos e a 
е Ө ев е е е е 9 ϱ 4 6 е © е 6 @ ὁ ϐὁ ϱ ϐ е е о 0 @ @ е е е е % е 9 ә Өө е ее O ооо 0 8 
мм 7275-59 9729995999900 
i ' | l I | | ! | | | | | 


++. o К СОХ СОР ҮР СО СО СС СО сп У У СО СОР СО СО СО СОЁ СО MS SS Mmm 
ο ο f eT Ln ene nee et 
| | Py Ue тт ти Pe 18 | I| | 19181] | | Pi rarer! ! 
ο ΙΟ ΗΕ ΗΕ ΗΕ UU UU LLE UU U UG U А ишш шш шц шш ш UU UU UG U u UU U U US 
WMODOFODOMNONMDDODONN СУ СС СО [с СМ СО С ОУ СОО ОУ ХО ч САЛАКА АСМА MAO MO +FDO 
ОФ со Uu чў πο 9060 NP O ej чс) ОСЫ! ОО МО ОС ч РС < СО КЗ © НОГ o O 
Mm OD NSAI AKO AO M 00 e e К ИГ Се м СУ ч ОЎ СУ ч р ALA MG “У с ч ч 
ее o 9* @ е 6 е 9 o е е ә Ө е е 9 4 е 6 е 9" à % е е е е еее е 9 Ә а е @ o @ ὁ ὐ 0 ә 9 е 
,..,.;,,.,.,, Т το τν πο τσ τπτ Snn 
| ! | | | ! | . 


SOS ESSE OS r АВ со са Е са АВ АВ АВ АР АН СО СО mm me ав сеир ит со e ЧЕ ХР АВ СО са Е 
2000020000000000000000000000000000000000000000 
AA A eT Te tea ei eae te 
ша uy WU Wd Шш EU UU UU U Uu US U UU UG Uu U Uu uu U u U U нш шшш шш Шш uu U U a Us iy DL 


NAO СС) ССГ СО О С^ со ОУ СО СП СО { С O2 o0 (0 49 02 00. 00 «Fr. CO СЯ В + .O O Ln O o0 U CN 00 UO UY UY LY COO UO CNJ UN 

СУМУ + O m OO +f OY (N ñ — cO ++ LA O [= ++ try + rN in CO OQ co О ФО о Оо ооо по => —= For co ОСУ 

Dima MA LOA Ol ч ОА СМ оо ч AA η οσο Οπή οι ч О СУ СУ ан 

ее 60 060 e 06 6 4 06 06 е е 6 0 06 ο 06 6 0 06 е 6 3 ә е 06 06 е q 6 6 е е е е 06 6 е 6 4 е 6 9 9 е 

E A DO ορ СО С СЗСО СЗ 
| | | 


FNM О O0 OO dO О со Оо ч {О-оо О ао с СО Чела Л) 
AA A A A A A A AA С УСУ СУ СУ СОУСУ УСУ СУ е УСО СС СТ) СС ГО сеу ЧОЧ a T 


AVERAGE ERRORS 


MEAN SQUARE 
ERROR 


ERROR 


MEAN SQUARE 
NOISE 


NOISE 


ATITUDE 


0.126Е-07 0.325E-04 9:13 ТЕ- ОТ 


0.814E-05 


CNGITUDE 


738 





MONTE CARLO SIMULATION ERROR ANALYSIS 
ESTIMATED EMITMER POSITION ERROR IN NAUTICAL MILES 


EXTENDED KALMAN FILTER 
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NAVIGATION DATA FILTER PARAMETERS 
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NAVIGATICN DATA FILTER PARAMETERS 


E PAM SLATD VELED ELON SLOND 


VELND 


K 


QC C9 00 «F CN eU 09 «40 OO P- e CO (000000 cq AU © ЮО оо Оч О СО yn 0 ALO y OO m ЭГ N N TOM ч Осуу Оо Чоч осоо t 
+f NON AD à Oro or eda OOOrnr-oj me ed den A SO US (0 O^ NM AIO MN ДЕ КИ РР СО Г CO) e Xr (NJ — O cC2 cO C" с CN AO C9 CO (0 
ссоссочочосенобдочочосочсотсоосчсоетччогоосесочототосоососовостсевот 4С О О4О ч 
С) С) О\ O O O) G: O O GQ. Q: QG: O O; G: O O G' O QO © С О\ © О\ С© су О\ О\ G; O O Q Q` G: Q) O t O Q° Q: Q) s O O Q O Q` O; Q: Q) Q) O о О O O O ct O 
UO LO ELA LALA LALA E E LALA E LALA LA LALALA e LA SEL IO «ru uu SS SEEN SL SPS SFE LEED ELA LA SPS SP TT irt А 
8 e € 9 ο 9 ә ә 89 Q @ 6 0 0 Q 0 9 0 0 9 ә 0 0 е 9? @ © © 9 9 е ә 9? 09 6 9? ϱ 9 9 9 9 @ 9 9 9 5 @ 0 8 9 9 9 өө @ @ 9 9 9 ? ο 
CO CO CQ cO CO CQ cO CO CO CO CO co CO CO CO CQ CQ CO CQ cO GO CO cO CO CO. 00 CC: oO CO CO co CO CQ CQ CQ cO CQ CO cO CQ CO CO CO op CQ CQ 00 CO CQ CQ CQ co CO CQ cQ CQ CO CQ CO cO CQ 
— — — — c c ec o c c «4 c — e — A A A AA e e e rra) e e — — — Te e e 
чыч A c c C ο ο ο ο «4 SpA ο. «+ «4 «ч ο ο «+ re «+ 
II A E IIED EI ии 


MOY 04 0^ ax OO Q^ qo ++ ++ un ООШ усо Осу O Оса мен с СМ Ол ХР СО АЕ СУ ССИССО СОХО СО СИ Оо «T e e 0 00 Q^ «0 cO 0 e Oi O LO ο 
Q CN eA C0 00 e 00 e CJ SO e e 009 0000 Q9 X CO SO (000 CN XP O^ Q^ e e XT Xr Xr 00 P UO eo Οσοι eS 00 О «T P9 US XP P- СО СО 064099 OA NM 
ООО С\) с\у СО с©у СО СО с\) СО em c em dm eO -O0 QOO HOO QXO c) OnmqQO СО СО OnO O OONJINO Oc O OO QO m eO QXO 0 HO OO (0) QO я 
SOMO DAA COCICOCOC)OD OC COD OOCOCO0O0OOOOQOOOOOOOOOOGOOOOOOOOOOO 
лене cmo OSUOGOOOGCOOOCCCOOQOOCOOOQOOQOOOOOOOOOOGOOOOOOOOdoo 
9€ e 6 9* o O 9 9 9 a € 9 oo е % ә 6 ә е Ә $9 9 9 Φ 9 ә 9 2? % 9 9 е 06 0 0 0 4 0 0.4. во %9 ә 6 %9 o Q $9 9 9? д 9* 9 9 9 ә 9 9 Фф 
(аю со са) (сю СЕ ар = c e ΩΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟ ΟΟΟΟΟΟ ΟΟΟΟΟΟΟΟΟΟ 
! | I| | ! | ! | | | | | | i i | i | | | l | rid | 


О УСУ ою очсо OQ (NJ CO X О ч СООСУ 0^ + 09 CIA: C0 0 08 OO 09 x F 0I A UY €N QO 60 Г Ц OQ CN Oun ru p- O + n 9 ОО (0 e eO P P- 
Q) O O O mH c c dc 00 о AO HOO ооо оно 10000100 000000 A0000O0A000 0000 
c e e c o I000 000000) O0 ele OOoOOOOOOOCOOO0OOOOCOOOOOcOOOOOoOOdocdG 
EccL ccm ood» Ως Ο ΟΩΟΩΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟΟ 
ооо ооо ооо ооо < ооо о осо ооо осо" 
9€ ә υὁ 8 8 @ %9 ә 9 Ә е 6 6 9 9 е % 09 е 9 0 0 @ ә P 0 2a 9 0 9 %9 : 9 @ е е 9 6 Ç $9 9 е е 90 8 9? ә 9 ә q % a 9 09 е %9 9 89 
са а 7 Zr 22220298098920009900909099090090909999 
| i | | | |! | {1 ND | | | i | | Il | | I | | | | ! 


со 09 COLO + co — c cQ O O C.G rn O in Ol NIDO + DOME М СУИС ШМ СМО О О ЧОО СЈО чо + CN OO О С СУ ОХО + un n 
с С) О с с) су СО ОГ} О\ ©О с АС ОО СО + О ТОГОО СЈО ОО ч чо дето Ос че O + GO nun OQ O + OS O 4 сс ч GO N 
DUANE (N.Q Q O: O Q un O MN CO rN QO Gy NO = CO Q O 100 O (0*0 O Sy ONO e eo oen Oo г +S gy n + O мою O CN OO 
DORM С ООо -+ Q — O cQ <O ++ rn — Q cQ О FMAOD VN MAODQOQNMHAWDDOAMNM FO DVO «T eq e 0 CO Ou (C) ч О О о сч О 
+ T + + ХР ар СУС са С са са СО СС Сус сен ен eie e COO C900 OO O0 G: O QA QA 090509 00 co CO CO P- P9 P- D P9 49 SO «OQ ^O «OsOU LO UY UO LO UY 
9€ υ 9 ә $ 8 ә 9 6 6 9 е е 9 ә 0ὁ 9 Φ 9$? Q % 09 ο е %9 о 9 9 9 90 е 0 0 0 0 ә @ 9 е 09 ? ә Q ϱ ὁ % Φ 9 %9 c. 9? $9 % 9? o 9 9? ә 9 Φ 9 
MOA MOYO HOMO e СО са Су СОЎ сеу СО СО су СС) СС су 00 001 00 C 09 00 Су ссу СО СО С) СУ Су СОЈ СУ Су С СС CV GJ ЈС Су СУ Су СУ СУ Су СУ С су СУ СУС СМ СУ СУ СМ (GJ CN 
en r 00 са r? co 9 9 c 00 00 со 009 00 €0) (91 e са €0 00 00 00) 060 09 00 00 MAM MMM MEY MMH MAM AM MM HMM MMMM MMA MOM MMM MM 


«QUUD m OC SQ OO ООО чус Сф UV COCO NIAID Ар СЪ СО О АКРА MTONOOM-TNWOTOTMNNOSLN 
POM DO + «O9 UO e CQ Un SO e eq 0 со 09 60 Q^ LO SO UY O^ 49 e eU OF сс $ < ч сс СО СО сеу СУС οσο ч АРА М $ ч я С гс С 
LA NOD C) e OO нон она oe С --с0000009ч4ч 4ч- чосзо4чпочо 4 чоч4-ч чо чоч чо 
AE EOOOCOOOOOOCOOOOOOOOOOOoOooooooooooooo 
m: ОООООСОСООЦОООООСО :ЫОООООЦООООООООЫЦ.Л:ЦЛОООООООООО 
е è è ә 6 ә е % е е % o 06 06 е 6 06 0 % 8 0 4 9%  % 9 е е е е 9 е 9 9? ә 8 е 9$ 9 е е 6 е ее е 6 е 0 60 4 0 . 0 0 е е 9 е 9 
ELLE dIouooOooococoooo)ooooooooocooo 
i | | і 1 | | | ΙΙ | ! ΠῚ 11 | ! | | | 


LAWN .O O cN. cQ (Q .Q + С Оса чо СО «0 0049 O ++ (NJ O CQ O FL) (N G: [= О ОО ОМ ЧМ ООСО Ом ОШО кусо с 
NN ч С оо со LA co M0 Mp 0 MM LADA 0 00 co or = co r= r r= = СХ со Q ООН СО ПО ГР оо Ог ло co СО со соо Љо 
СС са СС СС СС СС СС С СС СС СС СС СК ЈУ ССМ Су СУ СМ СУУС С СУ Дуе С С СУ у СӘС ССС СС Су СУ С СЧ СМ СК СС су СЪ (N 
len ОЗЭОООСОСОЭОООЭОЭоООООООООООООЦООООСОЦОООООООООООООООО 
RM есссссоссссосссссссоссосососсосооооооооооооооо 
€ 9 6 . 0 e 6 9 9 8 0 oO Q G 06 9 €9 0 8 ес 6 4 0 6 % o % 0  % o 9 6 o 06 68 е 6 9 е 686 ее 0 o0 98 0 6 0 9 9 е 8 e 9 о 0 
ссооососсоососососоососооососоооосоососоососсобооооссоФоосооссово 

I 1111 I| ! | | |! | | | | | шиш | ΙΙ 


ΓΙ 11811 Γι |! | 
eO OY X t! ΟΡ СО чу Ш ОМ со Т Оч УА О-О rO — ШОУ ООС Оо Мо СО ч УО ОМУ 9 ХО ч 
(03000 0300 T IFAN 


ши 
= CN cO 
AA A A et et OIA OANA IN OOOO OO + T+ LA LD LA LAU LA UNL SO 0 


19 





RALMAN  FILTERMPARAMETERS FOR ANGLE FILTER 


G2(K) 


G1(K) 


Pl2(Kl 


P11(K) 


K 


e Qu Qe X СЧ ССМ СУУ СУ СУ СМ СУ СМС οσο дошло -маз СУ о СУ СУ СУ СУ СУ ССМ СУ С СУ СМ СУ СМ СУ СМ СУС СЈ 
оо 16 0 9 9^ О Те оТ, Те Тете Тео Те 1610310 Те QA A (Q +C; n àO QAQA QA CA AG GA GA A A QY AGAR AC QA C YG GAI Os 
СО Fr CN A ——4 C C O COCO CO CO CO OO O OCO O OO CO OO OOO co pr CN —— —=— C OCO OO C OOOCOQCOOCOCOOODOOOO 
ӘООСОСОСЕ ССС ООООООООООООООООСООООСОООООООООООООООООО ООО 
Φ 90 9 9 9 9 9 Φ 9 9 Φ 9 9 ϱ 9 Φ 9 9 Φ 9 9 6 е о 9 4 0 0 ә 6 ә Ө 9* o 0 0 o 9 9 9 9 е 6 9 9 9 9 Ө 9 е е 90 9 ө ө 9 ө о 


QOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOooOooooooooooo 


DOD DAO 00 LA OS US «b src 00 09 69 6 NO m m e m m e ч СО О СС С GO e PM 90 e cU c0 0 uU NF XP 03 00 09 0 OV 06 N m em m me e 
ОООООООМО Oe Qq oo m m m» p P pP. D P P9 P9 P PP P P P9 PSP ОО Уо оо МОО чо МОГУ УГУ БГУ Б У УБ PO P P9 r 
Q^» Qr 004300 00 Os FNN A — — + mH ч ч ч ч — —=— —=— —— — QOO ЛО” О F NN mM ч ч ч ч ч — —=— ч Ч ч Ч ч — 
ООо ом Е ФЗ ЧҮ ТҮГҮ ЧҮЧҮ ЧҮ ЧО О ОГО ШАША ЧЇ ЧС ЧҮГҮ ЧҮЧҮ ЧҮҮ ЧҮҮ ҮҮЧҮ ҮЧҮ 
@ 9* 8 ә е е ә Q ә е 8 ο 9 9 Q 9? ә е 9 ә 9 9 8 о ә е е ә 9 9 9 9 ç 9* өө 9 9 9 9 ә 6 9 on 9 Ө 0 0 40 0 94 0 0 060 0 9 0 0 е 9 


Ο-οοοοοοοοοοοοοοοοοοοοοοοσοοσοοσοοοοοοςο”ποοσοοοοοοοοσώσοσοοοοσοοΟσοοσοοοσσσοσσσσο 


Со сы О о АО $ СС со DY CO Бъ У М М У М У Б М У У МЬ У У У ON OOD $ 9 © СО Вл ORR У М У У В М Г У У М У У М У 
DODO ROA DOP OHV ULLAL ALI LALA LALA LALO LALLA оО С О чоо CN OO P- OLA LALA LALA LA LALA EA LA LALA LOA LA LALA LA LA 
ONA DODENN HH em e N e e e e e e e N e e ei e Hm een ON TON NN A AAA AAA A A AA AA AA A A A A A A 
ооо соо оо ооо ом ооо ооо ооо ооо ооо ооо о 
e 9* e 9Φ 09 е 6 9 е е 6 е % 0 @ CO 9 9 o 9 ә 0@? 9 Ө 9 9 $9 9 4 . ОО е 05 9 4 0 6 0 6 0 6 6 94 0 6 е 9 9 9 0 6 0 0 0 0 е 6 9 9 9 


QOOQOOOOOOOOQOOQOQOoQOOOoOoooooooOoOoooooocoOooooodocococooooooooooooooooo 


12000 
12000 


ООО моо {ў оО е М чч (e eO 9 e P- P P D P К-К о О ШО С ОМО «fF 60 ea М e ОС НО 90 r У М P P М P 
OONO FDOM TDR НО о SO «SO 1 1 LOU UO UA UO LO LOL OO AND OO Fr O0 e eL ON CO «OO О SO DIO LALA LALA LALA LALA LALA 
ОО ч О — CÇ. + О ЦОО UL (OO eM ч A A A A A A —— —=— 0 CO OD e Q^ em O4 X О ЦСО U en CJ eM mM 0H —— = ч чч ч n< 
ООо «o9 cnr m mm m m mp p p P οοσς οι ч О СО МЫ МУ МБ МУ М ҺЫ М Ы ҺЫ М МЫ ҺЫ МЫ М ҺЫ М P Г 
e 9 e 9 ад 0 9 09 9 9 9 9 o 0 % 9 9 9 9 9 


OH ОСІ-"-ЧӘООООООООООООООООЫООООООООООО-ЯОСЦН-ЧОООООООООООООЦОЦОЦОООЦООООООО 


o oO 
oo O 
DO DO 
ely eM 
~ ~ 
— — 


= со Ол со и МУ ОХ ч СТУ М СХ ч С М ОЎ асу г С Се МО чуч Осо О оу осо ОЧ Осо чя Ооо ОСЧ Ооо +.O OO O 
INIA AQUA MOON OT SS SS punt FAL о — e mcm ΙΟ ΟΙ ΩΩ ΩΜΗ SF Jr NF XP UO UD UD IDOUD SO 

Ос Тс О К o oOomOrmsundor-ec]oauwm«ruxgr-(ogqcm-aowmsugo-o0g9g]omnawnmauom-(goonnenarm-«iuoro0o0oo 
AA AA AAA 4 С Суу СОЈ СЦ СЧ СЧ СМ СУ СУ СУ Се У = e e r e e ee a I ч СОЈ С с\у СМ СЦ СМ СУ СМ СМ СУ се 


e M em e en нч чч, м e e eM e eM eM e eM e em em eH em e em eR СО СМ СОЈ СО СМ с\ СМ М С СМ СУ СМ СУ СМ СУ Су СЧ СМ СМ С СУ Суу СМ С СМ СМ СУ СУ СМ ay 


80 





KALMAN FILTER PARAMETERS FOR ANGLE FILTER 
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EXTENDED KALMAN FILTER PARAMETERS 
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ШЕЛЕК ЕЧ Б ЕКСА МАМ FILTER IS ΙΝΙΤΙΑΤΕΟ АТН THE 
PuLCLOWI NG. ELLIPSE FOR CUI NUMBER 4 OF TARGET 2 

ВНЕ ANGUE BETWEEN THE MAJOR AXIS AND THE MERIDIAN 

ο ο ο THE CENTER OF THE ELLIPSE 15 122. 129 ЩОЕСКЕЕБ, 
IBLISMPENGIHSOE THE SEMI-MAJOR AXIS 15 0.261 DEGREES; 
Е ВЕМСТН СІГ “ІНЕ SEMI-—-MINUR AXIS 18 ο, ος ΡΕ ΤΕΕ. 
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EXTENDED KALMAN FILTER PARAMETERS 
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EAT ENDIEDEKOALMAN ЕТ ТЕК PARAMETERS 


PP T2 ЕБ ЖА Gl G2 


ERDI 


K 


F-OOYOOOOOOOOOoOoOoOOooOoooocoooooOo 
00 TAIN NARAINN AINA NAIA NN AION eee CJ 
νι CO OO OC OC OC OOC OC OOCOCOCOOOOOOO 
еее 9 çq е @ $9 е @ QQ @ @ Q 0 Q % а ее ее% ее ее е о €* 
COCO OO CO OOO сус) С) с) OC C CO OC OOCOQCOOCOOƏOOO 
| 


LNA М АСУ СЯ СМ CN SF ULYUNLO UY UY UY (CY LV UY LCY LY LCY (4 C UY 
ЦУ СУМУ О С 00 00 00 e e са СО 069 00 00 0653 060 СС) СС СС СС) СС e 
Осо оли + ФЕ РЕ ЕЕ y 
е 9 9 % е 9 @ e @ o  % е е % е @ 0 е 9 9 9 у о е 4 0 


осесесоссссосососссососососо 


e e CW (0 (0 00 0000 00 00 00 0 00 00 0 СО) СС 00) 00) 09 са e e en e IN 
MRI η’ η ΠΟ φῇ AY 
| 1811 | ae el РМ! | | ! | 
Шш шшш шшш шыш ши) Шш ишш шш шшш шш 
ANAM Ос го O QUYA TO Y «O «9 DLL LALALA LA LALA La LALA 
P- 00 0N = mr tunt ооо ооо ооо 
CO e (N SÍ N іні гі гі гі гі ендігі ігі іі гі «4 4 шш 
e ọ 9 9 9 % Ө е 9 9 6 9 oe 9 9 9 @ e % 9 9 9 9 9 9 9 9 


осесососсссососсссовооссоспосо 


HA H NNN NNN NN NNN AN CIO СУ СУ СУ СУС С CONO 
— οσους ο OOOOOGOoOooOoOooouoooooco 
ΠΕΡΙ ЕТ м A te EO ee 
WW y US uu U U OW i U Wa ια μα Wu ea a Wu a Ls Wg Ws Pa Ww 
(сама оо $ АСЯ ат оо сос OA OCA OOO OO OA OO Or OY GN ON 
СОО СЈО СЧ СОГУ М МУ ММ У М У МУ М МУ М У К М 
АО со аб ыы,’ ‚+ 
8 6 6 ο вз е 
ОС аи ee a oSoo 


00 O Ar AA 4 «4 —— —=— —=— чн A іі тігі гін ігі ні еі 
A коес 

| | | | l | Т | | | | 1 | 
a emnt RR RERO AA 
FAN ОЧ АСОС LA O LALALA LALA LALA LALA LALALA 
(ПРО ЗОО со Г- 0000 69 00 00 00 CQ CQ cO CO CQ cO 00 60 СО со 60 
Q^ CN CN e «O0 Un NP 00 00 00 00 00 СС СС СС 09 06 00 СС 00 00 (9 e e ea en ea 
ϱ ο 9 9 Ө 9 09 9$ G 9 9$ 4 9$ 9 9 Ө 6 9 9$ 9 9 90 ὁ 6 0 % 9 


OOCOOOOOOOOCOOOOOOOCOOOOOcoOcco 


co O c. + `Q eQ O бо `Q co O (N ооо 
А СУСС С С ССО СО ЧЧ Ч ЧР ЮАО 


XTD1 ΥΤΟΙ 


YTDDOT 


XTDDOT 


EY 


EX 


ОООО с ХЕ СО ООП оо ОГ ГО О СОУС ОР © 
ОСОО У-У оО ОГУ чо ч моо ОГУ 
ООООСОХОГ-О ОЛ со сос AO O 090100 09 Pb г- 
Q. On Ox OO CO GO 09 00 00 00 00 00 00 05 02 CO o5 00 00 ο ο 
ее 9 o è ù е ее 0 Q @ o È o O до е % е е % е е ее 
NNN N NN NN NN NN NN NN NN N NNN NN NN N 
OAM MAM MAM MAM MMM MMA СС) СО 00 00 00 00 00 са со са сд са СО СС 


O (N.O O 000 О + — О Ч М ОХ СМ car uu 09 oo (N = 
Q9 *Q (300 (n «Q ey oo P- MMO NAH O О ОГУ СОМ da 
«xx Sgeym С СО ОУ ОУ со - М ОШ Y Y NANO A Al 
+++: Зо м м со со со сос со со саса саса СС СО) СС) 
e 9 9 ç «ее Q q ее $9 99 ὁ Q е еее 9? е е @ e$, 9 е 
Nr rn rm rn rn P P P nm, m 
ч ч — — — — — — — — — — e m e r e —— — — — ——— 
ме: 
шш үл ры кг a AN E | 


ОСЧ ч ЧО ЧОМУ О О ч ч АСО чч ч О О С со К-У о 
4 с) су СО СО СО СО CO O O —— ——=— —=—=——— == _ OO O 
со с) с) © о О Сс О сус)с) С) С) С) ооо 
сусу) С) СО су) СО СО су) СО С) с) С) С) С) С) С) OOOQOOOQOOoOQOOCOCCC 
e 9 9 9 9 e è @ Q @ q 9 9 е е @ Q 0 e @ @ 4 060 6 06 9 е 
G OO ο ος ο ου ου ου ο ο О 

IT I L JI j || l l ІІ 


О Ў ОГ co Go co GO cO [— О оо ОЧ cn (N QCN 
mOOOGCGOOOOOOOOOOOoOoOoOooooooooo 
и ооо соо ооо ооо 
ατα οοοοσοοσοοσοοοσοοσοσοοσσο 
€ ө е 9 ọ 9 % ә 8 9 ө 4 е 9 9 9 9 9 9 9 $9 Q Q ο Q 9 


СС ООООООООООООООООООО ООО 


с! СО СМ СООСУ Оч, сг ЯО (© Ou e O^ «ru + Dua mn 
оон ТС ОУ САГУ ч Омо ОО 4с] СО { О Оса 
ссе ооОоооооооооооооо 
Q O OO u 22292229299 
6 6 9 9 Ò оф ο ο 
jOOOOOOOOO0O00O000 
1 | ! | 


0 

0 

0 
FO 
-0.0 
=0 
-0 
-0.0 
-0.0 

0 
-0 

0 

"m 


OSM ADN ALA FO (СО ссү YO? NO YO mA Ωω -οι 
SF OA GLAM NOIA O NDA O NA MN YO MM AmMO 
OOOO" O 00500000 00000000 
EE usc 2220020000000 
гооо в 9 @ 8 8 е 9 9 9 9 ϱ 9 0 0 9? 9 q Q ө 9 ο 
ооо 
| 


ΟΟΟΟΟ сосоососсососооооосоооооо 
| II | ! 


co O (N + хо CO O CN. + .Q CQ O cN + .Q OO O (N + -O @ C r, осо 
eM em ге = CUONIOQCOq OO 00 09 00 0 00 SF X SS FLACA IN IAN O 


ДО 





TARGET NUMBER 1 


METERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 


K FREO PRF PW THETAD THTD SUAD ΠΠ 

1 1197.0 150.0 3.50 106.6854 106.6854 33.4991 -118.5004 
ОЛОТ О 150.0 3.59 104.1513 104.1513 33.4670 -118.5002 
5 1197.0 150.0 3.50 102.4055 102.3046 33.0926 =] 1, 50059 
EEUU D 150.0 3.50 100.5478 100.2979 3321000 -118.5012 


SMOOTHED INITIAL BEARING ANGLE = 106.68600 N 
FILTERED FINAL BEARING ANGLE = 100.29791 W 


VECTOR METEOD SGLUTIGN ΟΕ EMITTER LOCATION 
EMITTER LATITUDE = 33.24323 N 
EMITTER LONGITUDE =-117.49606 M 


EXTENDED KALMAN FILTER SOLUTION OF EMITTER LOCATION 
F IIJ TEPPPATLITUDE = 53.23833 М 
GMb WER LONGIWIVDE m— 7.45799) W 
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TARGET NUMBER 2 


mee TERED AND SMOOTHED EMITTER DATA CORRELATED TQ TARGET NUMBER 2 
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SMOOTHED INITIAL BEARING ANGLE = 123.13493 N 
FILTERED FINAL BEARING ANGLE = 118.21536 W 


VECEORBMENSODESOEUITON OF IGMITTER EBOATTION 
EMITTER LATITUDE = 32.90477 М 
EMITTER LONGITUDE =-117.44853 М 


EXTENDED КАЕМАМ FILTER SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 32.77782 N 
EMIG TER LONGITUDE =-117.31906 W 
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De PZN 


— 
—= 


ANGLE 


SMOOTHED INITIAL BEARING 


24.170815 W 


ENLTERED FINALE BEARING ANGLE 


νεο ο Е ТОВ ЕО ΟΝ ΠΡ ΕΜΙΤΤΕΕ ΕΡΕ ΑΤΤΟΝ 


ΘΟ ΙΝ 
15560555 м 


EMITTER LATITUDE 
EMITTER LONGITUDE 
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TARGET NUMBER 2 


Επ AND ЗМООТНЕО EMITTER DAMA CORRELATED ТО ТАКСЕТЕКОМВЕВ #2 


K FREQ РЕР PW THE TAD THTD SLAD SLOD 
3 2876.0 306.0 2.40 62.3831 62.3831 93.3109 .-120 49529 
20 20718.0 304.012.40 54.0991 54.0991 33. 4631 -120.6545 
POR S7370 306.0 12.30 31.1855 510311 Бао 931^ 04859503 
BOX оно 306.0 2.20 47.9846 48.0350 93.0803 20.4641 
43 2876.0 306.0 2.40 46.8625 46.0922 53.0342 14120 43590 
44 2816.0 306.0 2.30 44.9780 45.3923 3: 02598 2 120, 37 31 
И.О 306.0 2.50 41.8276 43.0553 43.002722120. 2898 
61 2816.0 306.0 2.30 38.91241 38.9379 32.9440 -120.1640 
65 2876.0 306.0 2.40 37.8948 31.8013 2.920812 -120,.1259 
SMOOTHED INiTIAL BEARING ANGLE = 62.38292 N 
FILTERED FINAL BEARING ANGLE = 37.80147 W 


VECT ORME THODSSGRUT RENEOF EMITTER COCATION 
EMITTER LATITUDE = 34.09401 N 
EMITTER LONGITUDE =-119.02849 W 
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TARGET NUMBER 


5 


FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 


К FREQ PRF Ри THE GAD 

D 2846.0 370.0 2.30 16. 3184 
ШІ 2585-0 370.0 2.30 13.9204 
292346: 0 370.0 2.40 10.2 144 
34 2846.0 370.0 2.40 69. 3484 
41 2846.0 370.0 2.40 67.6624 


SMOOTHED INITTAL BEARING ANGLE 
Pee RED FINAL BEARING ANGLE 


VECTBRE METHOD" SOCUTION 
ЕМ ΤΕ BUDE 
ЕМ ВИТ ЕБЕВОНО ВТОВЕ 


TITO SLAD SLOD 
{6.3184 33.2843 -120.8101 
13.9504 33H 185 - 120. 6815 
10.5609 В. 12 —120.5 9] 
67. 6206 33.0495 -120.3957 

/ 6.316531 N 
67.62057 W 


OF EMITTER LOCATION 
ΘΝ 
-118.1 609 W 
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4 


TARGET NUMBER 


4 


FILTERED AND SMOCTHED EMITTER DATA CORRELATED TO TARGET NUMBER 


Τ ΗΤΟ SLAD ΕΤ 


Tied AD 


PW 


PRF 


FREQ 


K 


69.86671 N 


SMOOTHED INITIAL BEARING ANGLE 


69. 16620 W 


FILTERED FINAL BEARING ANGLE 


Stoo SOLUTION О ЕВЕМТТТЕК ВОСАТТОНМ 
EMITTER CATI TUDE 
EMITTER LONGI TUDE 


VECTOR M: 


93229097 Ἡ 
=119.49136 W 


1453 


o 





TARGET NUMBER 


J 


FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 


К FREQ PRE PW THETAD 

11 5506.0 640.0 0.60 88.4148 

17 5504.0 640.0 0.60 86.4644 

38 5504.0 640.0 0.60 γιό ΙΡ 

45 5506.0 640.0 0.70 το. ΡΘΗ 

ο. ου ο 64220 0.60 68.6409 
БОП 540.0 0:60 66.9829 

60 5504.0 642.0 0.60 ОР 721 
SMOOTHED INITIAL BEARING ANGLE = 


FILTERED FINAL BEARING ANGLE 


VECTOR METHOD SOLUTION 
EMITTER LATITUDE = 
EMITTER LONGITUDE = 
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THAD SLAD 
88.4148 2392215 
86.4644 33.1942 
76.1742 SL 
72.2144 53.020885 
69.2354 52.5 9939 
66.8928 ва. 9749 
63.3594 2,9508 

88.414381 N 
63.35942 W 


OS SNTITERZEOCATTEN 


ΞΡ 
-119.45798 W 


5100 
=120.: яб 
=120: 6929 
= 2053435 
12022809 
=120, 2294 





TARGET NUMBER 6 


BU TEREDAOAND SMCOTHED? EMITTER DATA CORREUATED TO TARGET NUMBER 6 


K FREQ PRE PW TEETAD πι SLAD SiO 
2516.0 359.0 2.20 52.8601 52.8601 33, 223% 31120. 7302 
сете 0) 359.0 2.20 44.0398 44.0395 Ie αυ =l 26. 6249 
4l 2876.0 359.0 2.40 2322100 2R 2300 757 N15. 18/9 
Μι. te) 359.0 2.40 62.3096 32.3614 22:9926 = 120: 207I 
B 6.0 329,0 2.20 219243 2829272 Edo ο σι ο. δις 

SMOOTHED INITIAL BEARING ANGLE = 52.85960 N 

FILTERED FINAL BEARING ANGLE = 28.92722 W 


VECTORSME? HOD SOLUTMION OF EMITTERSECCATION 
EMITTER LATITUDE = 33.95410 N 
EMITTER CONGITUDE 119225852 W 
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TARGET NUMBER 


ШИШЕ РЕВ АМО SMOOTHED EMITTER DAT 


к ҒКЕО PRE PW THETAD 
ο ο ο. 500.0 0.20 48.3618 
БӘ 9258-0 499.0 0.20 44.3147 
Е 500.0 0.30 31.8228 


SMOOTHED INITIAL BEARING ANGLE 
BEETERED FINAL -BEARTNG ANGLEE 


ΝΕΟΤΕ ΤΕΥ» ἨΤΟΓΤΌΠ 
EMITTER LATITUDE 
EMIT HRSEGNOITODE 


1 


А СИБКЕГАТЕН ИН ТАВЬЕ И МОМВЕН 


THTD SLAD SLOD 
48.2618 33.1060 —120.'5182 
44.3147 292078 72120.4130 
οσα /3 52.96685 D PLI 

= 48.36174 М 
= 31.71735 Н 


OP EMITFER LOCATION 
34.12042 N 
-419 1295868 И 


— 
E 
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TARGET NUMBER 8 


ЕТІ ТЕКЕ) AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 8 


K FREQ PRE PW THETAD THTD SLAC SLOD 
24 2676.0 305.0 2.40 151616 85.1525 40.6 16.1 


SINGLE LINE BEARING 
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9 


TARGET NUMBER 


9 


BILTERED AND SMOOTHED EMITTER DATA CORRELATED το TARGET NUMBER 


THTD SLAD Sor 


PREF PW THE TAD 


ЕКЕО 


K 


t co OCO GY CN — 


«OQ «OU —— 
0 Ө 5 9 з о 5 
c es) ay οσα 
NANON AONAN 
ч ч ч 
ΤΙ 


ONIN OO CN e 


іч ΗΟ ΟἿ Ον Ον 
999 9 9 9 9 
сага Оса счечеч 
MMOH MOM 


соо стог ч 


€ 9 9 © oe ο $ 
r= .0 .O n + O % 
ТҮ СС СО сту СМ) СЫ, 


ceo UA COL CN cO O 
AAN DN Y n 
OM ODOR С\ 
C O + CY CNC u = 
8 9 9 9? ç 8 ϱ 
Оос! co O 
MAM QN e e 


со Оса e 
О-о ч 
o è © 9 9 е 
ld A A N Ss «+ 


сососоо 
e 9 9 «9 0ο 
SGUO OC 
SOL аве 
250052500 


4020-37 52500 
LAY LA LA LL 
UY UD UD UD UY Un US 
LO UO UD UD UO Un Un 


спин а е со ХР 
NNN ALN QO 


21.0615 (EN 


— 
— 


SMGOTHED INITIAL BEARING ANGLE 


18.34413 W 


— 
-- 


FILTERED FINAL BEARING ANGLE 


EMITTER LOCATION 


34.27957 N 
ИО ЛОВ ДЫ 


VECTOR METHOD SOLUFTTON TOF 


ЕМТИТЕВ МАТ I TUDE 
EMITTER LONGITUDE 
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TARGET NUMBER 10 


τ. τει AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 10 


К FREQ БЕР РИ THETAD 
21 A e 640.0 0.60 26.2854 
26 5504.0 640.0 0.69 253. 1807 


SMOOTHED INITIAL BEARING ANGLE 
Peet ERED FINAL@SEARING ANGLE 


νεο ο ο E Ti 5 p J DIII 
EMITIER LATITUDE 


EMITTER LONGI TUBE 


THTD SLAD See 
36.2854 33 410952 3120-6456 
35.1806 33. 14110 12025955 

= 36.28545 М 
= 35.18065 W 
OF EMITTERMEQCAT ION 
си са Дом 


=-118.84724 W 
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LARGET NUMBER If 


ВТ ЕКЕВ А SMOOTHED EMITTER DATA CORRELATED ТО GARGET NUMBER DL 


K FREQ РЕР PW ТНЕТАО THTD SLAD SLOD 
62 2874.0 359.0 2.40 59.5566 32.9406 -120.1563 


SINGLE τς Εκ νο 
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eb ewan tN PREPARE 


ЗШВКООПЕТ МЕ ТО ESTABL 


т 
MATRIX FOR SUBROUTINE Р 


Mus MEC TORSC ROSS PRODUCT 


О 


ә ее ее есе с есеесеегсегее еге ο οφ ος ο 690€ 0000009 o6 ee 8 o9? 0000€ 9.0 9090 


SUBROUTINE PREPAR (KI»K,SLAD,SLOD, THTDL, THTD,TLAD, 


] TLOD) 


DIMENSION SLAD(C1)« SLOD(1) s ACLAT( 2) X ACLON( 2) » THD(2] 
DATA PTRADZ/STE 295787 


ТНТІ= ТНТ 01 
THT=THTD 
DETERMINE DIRECTION OF TRACK 
DELLAD=SLAD(K) —SLAD(KI) 
DELLON=SLOD(K) -SLOD(KI) 
αντ O OLO. AND. CEW ONE OO ШО 
TRACK=90.-ATAN2(1DELLAD+DELLON)* PIRAD 
IF(TRACKSLT.0.0) ТВАСК-ТВАСК + 360, 
ТЕ НТ. ЕЛО ТКАСКСЗАМО.„ТН 1 „СЕ ТЕАСК? 560 ТО З 
Де THT Se RACK AND ТЕ ЕЕ ACK) CO T0 F 
DETERMINE NTE MMARGET TS ГЕРІ OR RICHT OF TRACK 
M=1 
N=2 
LE (TRACE Sa OIGO fas 
TECTHTE «UT. TRACK «AND. ННІ СЕ ШБАСИК-180.11 CO TO 40 
WG (THT AE W5.THENRSSCEORMACKtI180.JT GO TO 39 
BO TOZO 
CET ISE TONICA DE RACK 
ТЕСТЪТ OA T| a THT e60. 
ВЕЕТ πο ΑΝ πι το THTI=IHTIt360. 
ТЕ PEE CI πι GO TO 37 
M=2 _ 
N=1 
GO TO 41 


ЕТ ΗΝ ΤΕΕ ΠΕ ΤΝΑΕΚ 
Е(ТНШ 2 ТО. АМО ТНТ ЕТ: ОТ 1850 
F(THT.GT.270.AND.THT1.LT.90.) THT1=THT1+360. 
FETH 1 2 СО 10220 
ACLAT (M)=SLADCKT) 
CLAT(N)=SLAD(K) 
CLON(M) -SLOD(KI] 
CLONON )2 SLODLCK ) 
HD(M)=THT1 
HD(N)=THT 
ALL POSIT(ACLAT+«<ACLON y ТВ EASIEST C (0D 
RETURN 
BEARINGS -DO NOT CROSS SO NOP DLUPID RI wee ee 
TLAD=0.0 
TLOD=0.0 
RETURN 
END 


178 





SUBROUTI NE POSIT (SLA, SLO, THETA, TLA», TLO) 


SSBRDUTINE7TD COMPUTE TARGET SPOaSITTION COORDINATES 
ши мой МЕСТОБИМЕ ТНОВЪ 


DESCRIPTION QF CALLING ARGUMENTS 


SLA = АПРСКАЕЯ CA NAUDE 

SA ATREA СОУС УБЕ 

ФЕТА - REAP LNGRANG Pes — ОБА ЕИ 
TLA ТАКОЕ CAT MUDE 

TCO — TARGET LONGITUDE 


NRO SODIO 


89999 e e € «* o 9 € O € ^ e @ oO O € € O O O G G O @ O O9 9 O O9 O O O O O O € € ss oO 9 еге €9 9 Oo O 9 9 9 O 6 


SUBROUTH NE ΡΟΣΙ ορ αν 500, ΠΕΠ. π᾿ TUG? 
DIMENSION A(2)4B(2)4C(2)4SLA(C2)4 SLOC2) 4 THETA(2) 
DATA PIRADZ5722957187 


001 1-1. 
PH=SLACI)/PIRAD 
ТА- ай СТРУРТЕАШ 
DB=THEW AGC I) PIR AD 
ST=SIN(TH) 
CT=COS(TH) 
SP=SIN{ PH) 
CP=COS(PH) 
CO=COS (0B) 
SO=S 1 ШЕ 

C | COMPUTE NCRMAL T2 BEARING PLANE 
DX=-—SP*COEC T-ST“SO 
бҮ-50:“СТ--5Р: С2257 

Д [7 -C pe 

Е COMPUTE BEARING VECTORS 
X1=CP Em 
Y1=CP=ST 
AA=Y12# DZ-S P= DY 
ВВ-5Р:ОХ-ХТ DZ 
CC=X1#DY-Y1: DX ` 
О+5ОЕТ { АД 2+В В 2 + ССЕ #2) 
А(Т) -А Б 
В(Т) -ВВ/О 
СІ = СЕСЕ 

1 CONT [NG 

С COMPUTE TARGET POSITICN VECTOR IN (X,Y4,Z) COORDINATES 
X1=B(1)%* C(2)-C (1) B (2 ) 
A2=C CPA) SA (T) EI 
X32A(1)*BC2)-8 (1)? AC2) 
D=SQRT ( X12227) 2 +X 2222: 2 +X 3:x:X2 ) 
X1=X 10D 
Xx2=X 2080 

к X3 =X3 / D 

i: COMPUTE TARGET POSITION VECTOR IN (0-0) COORDINATES 
TLEO=ATAN2 ο АТТ ЕТЕР 

τ TLA=ATAN2(X30SORTOX IE 2 + Х2 2) ) > РТКАО 
RETURN 
END 
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CALL ІМЕСХХ, УУ, МАТА, А.В) 
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е. O 
--..) EM 
—J — > 
— C) <І 
со = 
<. e 
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πο ти е - 
— 9 к-к е ШЕ 
BANG C C909 «0 e 
à r ++ во C) 
< << m abe C 
H кс 7008 = 
N AUUO ~~ ο ο LL 
2 VII >x νο ~ 
г φ----  »-..α LJ 
ыы ниш 
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